Add Auto-MDIX support for INCA-IP
[oweals/u-boot.git] / drivers / inca-ip_sw.c
index e69de29bb2d1d6434b8b29ae775ad8c2e48c5391..42edca880f7fb8094a8ca7ef2b91b0cad52339d7 100644 (file)
@@ -0,0 +1,710 @@
+/*
+ * INCA-IP internal switch ethernet driver.
+ *
+ * (C) Copyright 2003
+ * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
+ *
+ * See file CREDITS for list of people who contributed to this
+ * project.
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.         See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
+ * MA 02111-1307 USA
+ */
+
+
+#include <common.h>
+
+#if (CONFIG_COMMANDS & CFG_CMD_NET) && defined(CONFIG_NET_MULTI) \
+       && defined(CONFIG_INCA_IP_SWITCH)
+
+#include <malloc.h>
+#include <net.h>
+#include <asm/inca-ip.h>
+#include <asm/addrspace.h>
+
+
+#define NUM_RX_DESC    PKTBUFSRX
+#define NUM_TX_DESC    3
+#define TOUT_LOOP      1000000
+
+
+#define DELAY  udelay(10000)
+
+#define DMA_WRITE_REG(reg, value) *((volatile u32 *)reg) = (u32)value;
+#define DMA_READ_REG(reg, value)    value = (u32)*((volatile u32*)reg)
+#define SW_WRITE_REG(reg, value)   \
+        *((volatile u32*)reg) = (u32)value;\
+        DELAY;\
+        *((volatile u32*)reg) = (u32)value;
+
+#define SW_READ_REG(reg, value)    \
+        value = (u32)*((volatile u32*)reg);\
+        DELAY;\
+        value = (u32)*((volatile u32*)reg);
+
+#define INCA_DMA_TX_POLLING_TIME       0x07
+#define INCA_DMA_RX_POLLING_TIME       0x07
+
+#define INCA_DMA_TX_HOLD   0x80000000
+#define INCA_DMA_TX_EOP    0x40000000
+#define INCA_DMA_TX_SOP    0x20000000
+#define INCA_DMA_TX_ICPT   0x10000000
+#define INCA_DMA_TX_IEOP   0x08000000
+
+#define INCA_DMA_RX_C   0x80000000
+#define INCA_DMA_RX_SOP 0x40000000
+#define INCA_DMA_RX_EOP 0x20000000
+
+/************************ Auto MDIX settings ************************/
+#define INCA_IP_AUTO_MDIX_LAN_PORTS_DIR      INCA_IP_Ports_P1_DIR
+#define INCA_IP_AUTO_MDIX_LAN_PORTS_ALTSEL   INCA_IP_Ports_P1_ALTSEL  
+#define INCA_IP_AUTO_MDIX_LAN_PORTS_OUT      INCA_IP_Ports_P1_OUT
+#define INCA_IP_AUTO_MDIX_LAN_GPIO_PIN_RXTX  16
+
+#define WAIT_SIGNAL_RETRIES                  100
+#define WAIT_LINK_RETRIES                    100
+#define LINK_RETRY_DELAY                     300  /* ms */
+/********************************************************************/
+
+typedef struct
+{
+       union {
+               struct {
+                       volatile u32 HOLD                :1;
+                       volatile u32 ICpt                :1;
+                       volatile u32 IEop                :1;
+                       volatile u32 offset              :3;
+                       volatile u32 reserved0           :4;
+                       volatile u32 NFB                 :22;
+               }field;
+
+               volatile u32 word;
+       }params;
+
+       volatile u32 nextRxDescPtr;
+
+       volatile u32 RxDataPtr;
+
+       union {
+               struct {
+                       volatile u32 C                   :1;
+                       volatile u32 Sop                 :1;
+                       volatile u32 Eop                 :1;
+                       volatile u32 reserved3           :12;
+                       volatile u32 NBT                 :17;
+               }field;
+
+               volatile u32 word;
+       }status;
+
+} inca_rx_descriptor_t;
+
+
+typedef struct
+{
+       union {
+               struct {
+                       volatile u32 HOLD                :1;
+                       volatile u32 Eop                 :1;
+                       volatile u32 Sop                 :1;
+                       volatile u32 ICpt                :1;
+                       volatile u32 IEop                :1;
+                       volatile u32 reserved0           :5;
+                       volatile u32 NBA                 :22;
+               }field;
+
+               volatile u32 word;
+       }params;
+
+       volatile u32 nextTxDescPtr;
+
+       volatile u32 TxDataPtr;
+
+       volatile u32 C                   :1;
+       volatile u32 reserved3           :31;
+
+} inca_tx_descriptor_t;
+
+
+static inca_rx_descriptor_t rx_ring[NUM_RX_DESC] __attribute__ ((aligned(16)));
+static inca_tx_descriptor_t tx_ring[NUM_TX_DESC] __attribute__ ((aligned(16)));
+
+static int tx_new, rx_new, tx_hold, rx_hold;
+static int tx_old_hold = -1;
+static int initialized  = 0;
+
+
+static int inca_switch_init(struct eth_device *dev, bd_t * bis);
+static int inca_switch_send(struct eth_device *dev, volatile void *packet,
+                                                 int length);
+static int inca_switch_recv(struct eth_device *dev);
+static void inca_switch_halt(struct eth_device *dev);
+static void inca_init_switch_chip(void);
+static void inca_dma_init(void);
+static int inca_amdix(void);
+
+
+int inca_switch_initialize(bd_t * bis)
+{
+       struct eth_device *dev;
+
+#if 0
+       printf("Entered inca_switch_initialize()\n");
+#endif
+
+       if (!(dev = (struct eth_device *) malloc (sizeof *dev))) {
+               printf("Failed to allocate memory\n");
+               return 0;
+       }
+       memset(dev, 0, sizeof(*dev));
+
+       inca_dma_init();
+
+       inca_init_switch_chip();
+       
+       inca_amdix();
+
+       sprintf(dev->name, "INCA-IP Switch");
+       dev->init = inca_switch_init;
+       dev->halt = inca_switch_halt;
+       dev->send = inca_switch_send;
+       dev->recv = inca_switch_recv;
+
+       eth_register(dev);
+
+#if 0
+       printf("Leaving inca_switch_initialize()\n");
+#endif
+
+       return 1;
+}
+
+
+static int inca_switch_init(struct eth_device *dev, bd_t * bis)
+{
+       int i;
+       u32 v, regValue;
+       u16 wTmp;
+
+#if 0
+       printf("Entering inca_switch_init()\n");
+#endif
+
+       /* Set MAC address.
+        */
+       wTmp = (u16)dev->enetaddr[0];
+       regValue = (wTmp << 8) | dev->enetaddr[1];
+
+       SW_WRITE_REG(INCA_IP_Switch_PMAC_SA1, regValue);
+
+       wTmp = (u16)dev->enetaddr[2];
+       regValue = (wTmp << 8) | dev->enetaddr[3];
+       regValue = regValue << 16;
+       wTmp = (u16)dev->enetaddr[4];
+       regValue |= (wTmp<<8) | dev->enetaddr[5];
+
+       SW_WRITE_REG(INCA_IP_Switch_PMAC_SA2, regValue);
+
+       /* Initialize the descriptor rings.
+        */
+       for (i = 0; i < NUM_RX_DESC; i++)
+       {
+               inca_rx_descriptor_t * rx_desc = KSEG1ADDR(&rx_ring[i]);
+               memset(rx_desc, 0, sizeof(rx_ring[i]));
+
+               /* Set maximum size of receive buffer.
+                */
+               rx_desc->params.field.NFB = PKTSIZE_ALIGN;
+
+               /* Set the offset of the receive buffer. Zero means
+                * that the offset mechanism is not used.
+                */
+               rx_desc->params.field.offset = 0;
+
+               /* Check if it is the last descriptor.
+                */
+               if (i == (NUM_RX_DESC - 1)) {
+                       /* Let the last descriptor point to the first
+                        * one.
+                        */
+                       rx_desc->nextRxDescPtr = KSEG1ADDR((u32)rx_ring);
+               } else {
+                       /* Set the address of the next descriptor.
+                        */
+                       rx_desc->nextRxDescPtr = (u32)KSEG1ADDR(&rx_ring[i+1]);
+               }
+
+               rx_desc->RxDataPtr = (u32)KSEG1ADDR(NetRxPackets[i]);
+       }
+
+#if 0
+       printf("rx_ring = 0x%08X 0x%08X\n", (u32)rx_ring, (u32)&rx_ring[0]);
+       printf("tx_ring = 0x%08X 0x%08X\n", (u32)tx_ring, (u32)&tx_ring[0]);
+#endif
+
+       for (i = 0; i < NUM_TX_DESC; i++) {
+               inca_tx_descriptor_t * tx_desc = KSEG1ADDR(&tx_ring[i]);
+
+               memset(tx_desc, 0, sizeof(tx_ring[i]));
+
+               tx_desc->params.word       = 0;
+               tx_desc->params.field.HOLD = 1;
+               tx_desc->C                 = 1;
+
+                       /* Check if it is the last descriptor.
+                        */
+               if (i == (NUM_TX_DESC - 1)) {
+                               /* Let the last descriptor point to the
+                                * first one.
+                                */
+                       tx_desc->nextTxDescPtr = KSEG1ADDR((u32)tx_ring);
+               } else {
+                               /* Set the address of the next descriptor.
+                                */
+                       tx_desc->nextTxDescPtr = (u32)KSEG1ADDR(&tx_ring[i+1]);
+               }
+       }
+
+       /* Initialize RxDMA.
+        */
+       DMA_READ_REG(INCA_IP_DMA_DMA_RXISR, v);
+#if 0
+       printf("RX status = 0x%08X\n", v);
+#endif
+
+       /* Writing to the FRDA of CHANNEL.
+        */
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_RXFRDA0, (u32)rx_ring);
+
+       /* Writing to the COMMAND REG.
+        */
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_RXCCR0,
+                     INCA_IP_DMA_DMA_RXCCR0_INIT);
+
+       /* Initialize TxDMA.
+        */
+       DMA_READ_REG(INCA_IP_DMA_DMA_TXISR, v);
+#if 0
+       printf("TX status = 0x%08X\n", v);
+#endif
+
+       /* Writing to the FRDA of CHANNEL.
+        */
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_TXFRDA0, (u32)tx_ring);
+
+       tx_new = rx_new = 0;
+
+       tx_hold = NUM_TX_DESC - 1;
+       rx_hold = NUM_RX_DESC - 1;
+
+#if 0
+       rx_ring[rx_hold].params.field.HOLD = 1;
+#endif
+       /* enable spanning tree forwarding, enable the CPU port */
+       /* ST_PT:
+        *      CPS (CPU port status)   0x3 (forwarding)
+        *      LPS (LAN port status)   0x3 (forwarding)
+        *      PPS (PC port status)    0x3 (forwarding)
+        */
+       SW_WRITE_REG(INCA_IP_Switch_ST_PT,0x3f);
+
+#if 0
+       printf("Leaving inca_switch_init()\n");
+#endif
+
+       return 0;
+}
+
+
+static int inca_switch_send(struct eth_device *dev, volatile void *packet,
+                                                 int length)
+{
+       int                    i;
+       int                    res         = -1;
+       u32                    command;
+       u32                    regValue;
+       inca_tx_descriptor_t * tx_desc     = KSEG1ADDR(&tx_ring[tx_new]);
+
+#if 0
+       printf("Entered inca_switch_send()\n");
+#endif
+
+       if (length <= 0) {
+               printf ("%s: bad packet size: %d\n", dev->name, length);
+               goto Done;
+       }
+
+       for(i = 0; tx_desc->C == 0; i++) {
+               if (i >= TOUT_LOOP) {
+                       printf("%s: tx error buffer not ready\n", dev->name);
+                       goto Done;
+               }
+       }
+
+       if (tx_old_hold >= 0) {
+               KSEG1ADDR(&tx_ring[tx_old_hold])->params.field.HOLD = 1;
+       }
+       tx_old_hold = tx_hold;
+
+       tx_desc->params.word =
+                       (INCA_DMA_TX_SOP | INCA_DMA_TX_EOP | INCA_DMA_TX_HOLD);
+
+       tx_desc->C = 0;
+       tx_desc->TxDataPtr = (u32)packet;
+       tx_desc->params.field.NBA = length;
+
+       KSEG1ADDR(&tx_ring[tx_hold])->params.field.HOLD = 0;
+
+       tx_hold = tx_new;
+       tx_new  = (tx_new + 1) % NUM_TX_DESC;
+
+
+       if (! initialized) {
+               command = INCA_IP_DMA_DMA_TXCCR0_INIT;
+               initialized = 1;
+       } else {
+               command = INCA_IP_DMA_DMA_TXCCR0_HR;
+       }
+
+       DMA_READ_REG(INCA_IP_DMA_DMA_TXCCR0, regValue);
+       regValue |= command;
+#if 0
+       printf("regValue = 0x%x\n", regValue);
+#endif
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_TXCCR0, regValue);
+
+#if 1
+       for(i = 0; KSEG1ADDR(&tx_ring[tx_hold])->C == 0; i++) {
+               if (i >= TOUT_LOOP) {
+                       printf("%s: tx buffer not ready\n", dev->name);
+                       goto Done;
+               }
+       }
+#endif
+       res = length;
+Done:
+#if 0
+       printf("Leaving inca_switch_send()\n");
+#endif
+       return res;
+}
+
+
+static int inca_switch_recv(struct eth_device *dev)
+{
+       int                    length  = 0;
+       inca_rx_descriptor_t * rx_desc;
+
+#if 0
+       printf("Entered inca_switch_recv()\n");
+#endif
+
+       for (;;) {
+               rx_desc = KSEG1ADDR(&rx_ring[rx_new]);
+
+               if (rx_desc->status.field.C == 0) {
+                       break;
+               }
+
+#if 0
+               rx_ring[rx_new].params.field.HOLD = 1;
+#endif
+
+               if (! rx_desc->status.field.Eop) {
+                       printf("Partly received packet!!!\n");
+                       break;
+               }
+
+               length = rx_desc->status.field.NBT;
+               rx_desc->status.word &=
+                        ~(INCA_DMA_RX_EOP | INCA_DMA_RX_SOP | INCA_DMA_RX_C);
+#if 0
+{
+  int i;
+  for (i=0;i<length - 4;i++) {
+    if (i % 16 == 0) printf("\n%04x: ", i);
+    printf("%02X ", NetRxPackets[rx_new][i]);
+  }
+  printf("\n");
+}
+#endif
+
+               if (length) {
+#if 0
+                       printf("Received %d bytes\n", length);
+#endif
+                       NetReceive((void*)KSEG1ADDR(NetRxPackets[rx_new]),
+                                   length - 4);
+               } else {
+#if 1
+                       printf("Zero length!!!\n");
+#endif
+               }
+
+
+               KSEG1ADDR(&rx_ring[rx_hold])->params.field.HOLD = 0;
+
+               rx_hold = rx_new;
+
+               rx_new = (rx_new + 1) % NUM_RX_DESC;
+       }
+
+#if 0
+       printf("Leaving inca_switch_recv()\n");
+#endif
+
+       return length;
+}
+
+
+static void inca_switch_halt(struct eth_device *dev)
+{
+#if 0
+       printf("Entered inca_switch_halt()\n");
+#endif
+
+#if 1
+       initialized = 0;
+#endif
+#if 1
+       /* Disable forwarding to the CPU port.
+        */
+       SW_WRITE_REG(INCA_IP_Switch_ST_PT,0xf);
+
+       /* Close RxDMA channel.
+        */
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_RXCCR0, INCA_IP_DMA_DMA_RXCCR0_OFF);
+
+       /* Close TxDMA channel.
+        */
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_TXCCR0, INCA_IP_DMA_DMA_TXCCR0_OFF);
+
+
+#endif
+#if 0
+       printf("Leaving inca_switch_halt()\n");
+#endif
+}
+
+
+static void inca_init_switch_chip(void)
+{
+       u32 regValue;
+
+       /* To workaround a problem with collision counter
+        * (see Errata sheet).
+        */
+       SW_WRITE_REG(INCA_IP_Switch_PC_TX_CTL, 0x00000001);
+       SW_WRITE_REG(INCA_IP_Switch_LAN_TX_CTL, 0x00000001);
+
+#if 1
+       /* init MDIO configuration:
+        *      MDS (Poll speed):       0x01 (4ms)
+        *      PHY_LAN_ADDR:           0x06
+        *      PHY_PC_ADDR:            0x05
+        *      UEP (Use External PHY): 0x00 (Internal PHY is used)
+        *      PS (Port Select):       0x00 (PT/UMM for LAN)
+        *      PT (PHY Test):          0x00 (no test mode)
+        *      UMM (Use MDIO Mode):    0x00 (state machine is disabled)
+        */
+       SW_WRITE_REG(INCA_IP_Switch_MDIO_CFG, 0x4c50);
+
+       /* init PHY:
+        *      SL (Auto Neg. Speed for LAN)
+        *      SP (Auto Neg. Speed for PC)
+        *      LL (Link Status for LAN)
+        *      LP (Link Status for PC)
+        *      DL (Duplex Status for LAN)
+        *      DP (Duplex Status for PC)
+        *      PL (Auto Neg. Pause Status for LAN)
+        *      PP (Auto Neg. Pause Status for PC)
+        */
+       SW_WRITE_REG (INCA_IP_Switch_EPHY, 0xff);
+
+       /* MDIO_ACC:
+        *      RA (Request/Ack)  0x01 (Request)
+        *      RW (Read/Write)   0x01 (Write)
+        *      PHY_ADDR          0x05 (PC)
+        *      REG_ADDR          0x00 (PHY_BCR: basic control register)
+        *      PHY_DATA          0x8000
+        *                    Reset                   - software reset
+        *                    LB (loop back)          - normal
+        *                    SS (speed select)       - 10 Mbit/s
+        *                    ANE (auto neg. enable)  - enable
+        *                    PD (power down)         - normal
+        *                    ISO (isolate)           - normal
+        *                    RAN (restart auto neg.) - normal
+        *                    DM (duplex mode)        - half duplex
+        *                    CT (collision test)     - enable
+        */
+       SW_WRITE_REG(INCA_IP_Switch_MDIO_ACC, 0xc0a09000);
+
+       /* MDIO_ACC:
+        *      RA (Request/Ack)  0x01 (Request)
+        *      RW (Read/Write)   0x01 (Write)
+        *      PHY_ADDR          0x06 (LAN)
+        *      REG_ADDR          0x00 (PHY_BCR: basic control register)
+        *      PHY_DATA          0x8000
+        *                    Reset                   - software reset
+        *                    LB (loop back)          - normal
+        *                    SS (speed select)       - 10 Mbit/s
+        *                    ANE (auto neg. enable)  - enable
+        *                    PD (power down)         - normal
+        *                    ISO (isolate)           - normal
+        *                    RAN (restart auto neg.) - normal
+        *                    DM (duplex mode)        - half duplex
+        *                    CT (collision test)     - enable
+        */
+       SW_WRITE_REG(INCA_IP_Switch_MDIO_ACC, 0xc0c09000);
+
+#endif
+
+       /* Make sure the CPU port is disabled for now. We
+        * don't want packets to get stacked for us until
+        * we enable DMA and are prepared to receive them.
+        */
+       SW_WRITE_REG(INCA_IP_Switch_ST_PT,0xf);
+
+       SW_READ_REG(INCA_IP_Switch_ARL_CTL, regValue);
+
+       /* CRC GEN is enabled.
+        */
+       regValue |= 0x00000200;
+       SW_WRITE_REG(INCA_IP_Switch_ARL_CTL, regValue);
+
+       /* ADD TAG is disabled.
+        */
+       SW_READ_REG(INCA_IP_Switch_PMAC_HD_CTL, regValue);
+       regValue &= ~0x00000002;
+       SW_WRITE_REG(INCA_IP_Switch_PMAC_HD_CTL, regValue);
+}
+
+
+static void inca_dma_init(void)
+{
+       /* Switch off all DMA channels.
+        */
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_RXCCR0, INCA_IP_DMA_DMA_RXCCR0_OFF);
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_RXCCR1, INCA_IP_DMA_DMA_RXCCR1_OFF);
+
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_TXCCR0, INCA_IP_DMA_DMA_RXCCR0_OFF);
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_TXCCR1, INCA_IP_DMA_DMA_TXCCR1_OFF);
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_TXCCR2, INCA_IP_DMA_DMA_TXCCR2_OFF);
+
+       /* Setup TX channel polling time.
+        */
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_TXPOLL, INCA_DMA_TX_POLLING_TIME);
+
+       /* Setup RX channel polling time.
+        */
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_RXPOLL, INCA_DMA_RX_POLLING_TIME);
+
+       /* ERRATA: write reset value into the DMA RX IMR register.
+        */
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_RXIMR, 0xFFFFFFFF);
+
+       /* Just in case: disable all transmit interrupts also.
+        */
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_TXIMR, 0xFFFFFFFF);
+
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_TXISR, 0xFFFFFFFF);
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_RXISR, 0xFFFFFFFF);
+}
+
+static int inca_amdix(void)
+{
+       u32 regValue = 0;
+       int mdi_flag;
+       int retries;
+
+       /* Setup GPIO pins.
+        */
+       *INCA_IP_AUTO_MDIX_LAN_PORTS_DIR    |= (1 << INCA_IP_AUTO_MDIX_LAN_GPIO_PIN_RXTX);
+       *INCA_IP_AUTO_MDIX_LAN_PORTS_ALTSEL |= (1 << INCA_IP_AUTO_MDIX_LAN_GPIO_PIN_RXTX);
+
+       /* Wait for signal.
+        */
+       retries = WAIT_SIGNAL_RETRIES;
+       while (--retries)
+       {
+               SW_WRITE_REG(INCA_IP_Switch_MDIO_ACC,
+                               (0x1 << 31) |   /* RA           */
+                               (0x0 << 30) |   /* Read         */
+                               (0x6 << 21) |   /* LAN          */
+                               (17  << 16));   /* PHY_MCSR     */
+               do
+               {
+                       SW_READ_REG(INCA_IP_Switch_MDIO_ACC, regValue);
+               }
+               while (regValue & (1 << 31));
+
+               if (regValue & (1 << 1))
+               {
+                       /* Signal detected */
+                       break;
+               }
+       }
+
+       if (!retries)
+               return -1;
+
+       /* Set MDI mode.
+        */
+       *INCA_IP_AUTO_MDIX_LAN_PORTS_OUT &= ~(1 << INCA_IP_AUTO_MDIX_LAN_GPIO_PIN_RXTX);
+       mdi_flag = 1;
+
+       /* Wait for link.
+        */
+       retries = WAIT_LINK_RETRIES;
+       while (--retries)
+       {
+               udelay(LINK_RETRY_DELAY * 1000);
+               SW_WRITE_REG(INCA_IP_Switch_MDIO_ACC,
+                               (0x1 << 31) |   /* RA           */
+                               (0x0 << 30) |   /* Read         */
+                               (0x6 << 21) |   /* LAN          */
+                               (1   << 16));   /* PHY_BSR      */
+               do
+               {
+                       SW_READ_REG(INCA_IP_Switch_MDIO_ACC, regValue);
+               }
+               while (regValue & (1 << 31));
+
+               if (regValue & (1 << 2))
+               {
+                       /* Link is up */
+                       break;
+               }
+               else if (mdi_flag)
+               {
+                       /* Set MDIX mode */
+                       *INCA_IP_AUTO_MDIX_LAN_PORTS_OUT |= (1 << INCA_IP_AUTO_MDIX_LAN_GPIO_PIN_RXTX);
+                       mdi_flag = 0;
+               }
+               else
+               {
+                       /* Set MDI mode */
+                       *INCA_IP_AUTO_MDIX_LAN_PORTS_OUT &= ~(1 << INCA_IP_AUTO_MDIX_LAN_GPIO_PIN_RXTX);
+                       mdi_flag = 1;
+               }
+       }
+
+       if (!retries)
+               return -1;
+
+       return 0;
+}
+
+#endif