]> git.sur5r.net Git - u-boot/blobdiff - drivers/inca-ip_sw.c
More code cleanup
[u-boot] / drivers / inca-ip_sw.c
index 07e86fc5fcf097b0191bfcba336875f6406c17fb..ab22b4d5385417d5563bc73029157a6e3a129fcb 100644 (file)
@@ -1,7 +1,7 @@
 /*
  * INCA-IP internal switch ethernet driver.
  *
- * (C) Copyright 2003
+ * (C) Copyright 2003-2004
  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  *
  * See file CREDITS for list of people who contributed to this
@@ -14,7 +14,7 @@
  *
  * 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
+ * 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
 
 
 #define DELAY  udelay(10000)
+  /* Sometimes the store word instruction hangs while writing to one
+   * of the Switch registers. Moving the instruction into a separate
+   * function somehow makes the problem go away.
+   */
+static void SWORD(volatile u32 * reg, u32 value)
+{
+       *reg = value;
+}
 
 #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
-
+       SWORD(reg, value);\
+       DELAY;\
+       SWORD(reg, 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
+
+#define INCA_SWITCH_PHY_SPEED_10H      0x1
+#define INCA_SWITCH_PHY_SPEED_10F      0x5
+#define INCA_SWITCH_PHY_SPEED_100H     0x2
+#define INCA_SWITCH_PHY_SPEED_100F     0x6
+
+/************************ 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                       2000  /* 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;
+       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;
@@ -89,15 +110,13 @@ typedef struct
 
        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;
+       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;
@@ -108,17 +127,15 @@ typedef struct
 
 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;
+       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;
@@ -128,8 +145,8 @@ typedef struct
 
        volatile u32 TxDataPtr;
 
-       volatile u32 C                   :1;
-       volatile u32 reserved3           :31;
+       volatile u32 C                  :1;
+       volatile u32 reserved3          :31;
 
 } inca_tx_descriptor_t;
 
@@ -139,16 +156,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 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_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)
@@ -159,8 +176,7 @@ int inca_switch_initialize(bd_t * bis)
        printf("Entered inca_switch_initialize()\n");
 #endif
 
-       if (!(dev = (struct eth_device *) malloc (sizeof *dev)))
-       {
+       if (!(dev = (struct eth_device *) malloc (sizeof *dev))) {
                printf("Failed to allocate memory\n");
                return 0;
        }
@@ -170,6 +186,10 @@ int inca_switch_initialize(bd_t * bis)
 
        inca_init_switch_chip();
 
+#if defined(CONFIG_INCA_IP_SWITCH_AMDIX)
+       inca_amdix();
+#endif
+
        sprintf(dev->name, "INCA-IP Switch");
        dev->init = inca_switch_init;
        dev->halt = inca_switch_halt;
@@ -196,8 +216,8 @@ static int inca_switch_init(struct eth_device *dev, bd_t * bis)
        printf("Entering inca_switch_init()\n");
 #endif
 
-               /* Set MAC address.
-                */
+       /* Set MAC address.
+        */
        wTmp = (u16)dev->enetaddr[0];
        regValue = (wTmp << 8) | dev->enetaddr[1];
 
@@ -211,35 +231,31 @@ static int inca_switch_init(struct eth_device *dev, bd_t * bis)
 
        SW_WRITE_REG(INCA_IP_Switch_PMAC_SA2, regValue);
 
-               /* Initialize the descriptor rings.
-                */
-       for (i = 0; i < NUM_RX_DESC; i++)
-       {
+       /* 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.
-                        */
+               /* 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.
-                        */
+               /* 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.
-                                */
+               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.
-                                */
+               } else {
+                       /* Set the address of the next descriptor.
+                        */
                        rx_desc->nextRxDescPtr = (u32)KSEG1ADDR(&rx_ring[i+1]);
                }
 
@@ -251,58 +267,53 @@ static int inca_switch_init(struct eth_device *dev, bd_t * bis)
        printf("tx_ring = 0x%08X 0x%08X\n", (u32)tx_ring, (u32)&tx_ring[0]);
 #endif
 
-       for (i = 0; i < NUM_TX_DESC; i++)
-       {
+       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.word       = 0;
                tx_desc->params.field.HOLD = 1;
-               tx_desc->C                 = 1;
+               tx_desc->C                 = 1;
 
                        /* Check if it is the last descriptor.
                         */
-               if (i == (NUM_TX_DESC - 1))
-               {
+               if (i == (NUM_TX_DESC - 1)) {
                                /* Let the last descriptor point to the
                                 * first one.
                                 */
                        tx_desc->nextTxDescPtr = KSEG1ADDR((u32)tx_ring);
-               }
-               else
-               {
+               } else {
                                /* Set the address of the next descriptor.
                                 */
                        tx_desc->nextTxDescPtr = (u32)KSEG1ADDR(&tx_ring[i+1]);
                }
        }
 
-               /* Initialize RxDMA.
-                */
+       /* 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.
-                */
+       /* 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);
+       /* Writing to the COMMAND REG.
+        */
+       DMA_WRITE_REG(INCA_IP_DMA_DMA_RXCCR0, INCA_IP_DMA_DMA_RXCCR0_INIT);
 
-               /* Initialize TxDMA.
-                */
+       /* 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.
-                */
+       /* Writing to the FRDA of CHANNEL.
+        */
        DMA_WRITE_REG(INCA_IP_DMA_DMA_TXFRDA0, (u32)tx_ring);
 
        tx_new = rx_new = 0;
@@ -313,12 +324,12 @@ static int inca_switch_init(struct eth_device *dev, bd_t * bis)
 #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)
-          */
+       /* 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
@@ -329,36 +340,31 @@ 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_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]);
+       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)
-       {
+       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)
-               {
+       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)
-       {
+       if (tx_old_hold >= 0) {
                KSEG1ADDR(&tx_ring[tx_old_hold])->params.field.HOLD = 1;
        }
        tx_old_hold = tx_hold;
@@ -373,16 +379,13 @@ static int inca_switch_send(struct eth_device *dev, volatile void *packet,
        KSEG1ADDR(&tx_ring[tx_hold])->params.field.HOLD = 0;
 
        tx_hold = tx_new;
-       tx_new  = (tx_new + 1) % NUM_TX_DESC;
+       tx_new  = (tx_new + 1) % NUM_TX_DESC;
 
 
-       if (! initialized)
-       {
+       if (! initialized) {
                command = INCA_IP_DMA_DMA_TXCCR0_INIT;
                initialized = 1;
-       }
-       else
-       {
+       } else {
                command = INCA_IP_DMA_DMA_TXCCR0_HR;
        }
 
@@ -394,10 +397,8 @@ static int inca_switch_send(struct eth_device *dev, volatile void *packet,
        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)
-               {
+       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;
                }
@@ -414,19 +415,17 @@ Done:
 
 static int inca_switch_recv(struct eth_device *dev)
 {
-       int                    length  = 0;
+       int                    length  = 0;
        inca_rx_descriptor_t * rx_desc;
 
 #if 0
        printf("Entered inca_switch_recv()\n");
 #endif
 
-       for (;;)
-       {
+       for (;;) {
                rx_desc = KSEG1ADDR(&rx_ring[rx_new]);
 
-               if (rx_desc->status.field.C == 0)
-               {
+               if (rx_desc->status.field.C == 0) {
                        break;
                }
 
@@ -434,8 +433,7 @@ static int inca_switch_recv(struct eth_device *dev)
                rx_ring[rx_new].params.field.HOLD = 1;
 #endif
 
-               if (! rx_desc->status.field.Eop)
-               {
+               if (! rx_desc->status.field.Eop) {
                        printf("Partly received packet!!!\n");
                        break;
                }
@@ -454,16 +452,12 @@ static int inca_switch_recv(struct eth_device *dev)
 }
 #endif
 
-               if (length)
-               {
+               if (length) {
 #if 0
                        printf("Received %d bytes\n", length);
 #endif
-                       NetReceive((void*)KSEG1ADDR(NetRxPackets[rx_new]),
-                                   length - 4);
-               }
-               else
-               {
+                       NetReceive((void*)KSEG1ADDR(NetRxPackets[rx_new]), length - 4);
+               } else {
 #if 1
                        printf("Zero length!!!\n");
 #endif
@@ -495,16 +489,16 @@ static void inca_switch_halt(struct eth_device *dev)
        initialized = 0;
 #endif
 #if 1
-               /* Disable forwarding to the CPU port.
-                */
+       /* Disable forwarding to the CPU port.
+        */
        SW_WRITE_REG(INCA_IP_Switch_ST_PT,0xf);
 
-               /* Close RxDMA channel.
-                */
+       /* Close RxDMA channel.
+        */
        DMA_WRITE_REG(INCA_IP_DMA_DMA_RXCCR0, INCA_IP_DMA_DMA_RXCCR0_OFF);
 
-               /* Close TxDMA channel.
-                */
+       /* Close TxDMA channel.
+        */
        DMA_WRITE_REG(INCA_IP_DMA_DMA_TXCCR0, INCA_IP_DMA_DMA_TXCCR0_OFF);
 
 
@@ -519,88 +513,89 @@ static void inca_init_switch_chip(void)
 {
        u32 regValue;
 
-               /* To workaround a problem with collision counter
-                * (see Errata sheet).
-                */
+       /* 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)
-          */
+       /* 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)
-          */
+       /* 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)  - disable
-                                     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, 0xc0a08000);
-
-          /* 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)  - disable
-                                     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, 0xc0c08000);
+       /* 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.
-                */
+       /* 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.
-                */
+       /* CRC GEN is enabled.
+        */
        regValue |= 0x00000200;
        SW_WRITE_REG(INCA_IP_Switch_ARL_CTL, regValue);
 
-               /* ADD TAG is disabled.
-                */
+       /* 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);
@@ -609,8 +604,8 @@ static void inca_init_switch_chip(void)
 
 static void inca_dma_init(void)
 {
-               /* Switch off all DMA channels.
-                */
+       /* 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);
 
@@ -618,24 +613,205 @@ static void inca_dma_init(void)
        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.
-                */
+       /* Setup TX channel polling time.
+        */
        DMA_WRITE_REG(INCA_IP_DMA_DMA_TXPOLL, INCA_DMA_TX_POLLING_TIME);
 
-               /* Setup RX channel 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.
-                */
+       /* 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.
-                */
+       /* 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);
 }
 
+#if defined(CONFIG_INCA_IP_SWITCH_AMDIX)
+static int inca_amdix(void)
+{
+       u32 phyReg1 = 0;
+       u32 phyReg4 = 0;
+       u32 phyReg5 = 0;
+       u32 phyReg6 = 0;
+       u32 phyReg31 = 0;
+       u32 regEphy = 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);
+
+#if 0
+       /* 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, phyReg1);
+               } while (phyReg1 & (1 << 31));
+
+               if (phyReg1 & (1 << 1)) {
+                       /* Signal detected */
+                       break;
+               }
+       }
+
+       if (!retries)
+               goto Fail;
+#endif
+
+       /* 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, phyReg1);
+               } while (phyReg1 & (1 << 31));
+
+               if (phyReg1 & (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) {
+               goto Fail;
+       } else {
+               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, phyReg1);
+               } while (phyReg1 & (1 << 31));
+
+               /* Auto-negotiation / Parallel detection complete
+                */
+               if (phyReg1 & (1 << 5)) {
+                       SW_WRITE_REG(INCA_IP_Switch_MDIO_ACC,
+                               (0x1 << 31) |   /* RA           */
+                               (0x0 << 30) |   /* Read         */
+                               (0x6 << 21) |   /* LAN          */
+                               (31  << 16));   /* PHY_SCSR     */
+                       do {
+                               SW_READ_REG(INCA_IP_Switch_MDIO_ACC, phyReg31);
+                       } while (phyReg31 & (1 << 31));
+
+                       switch ((phyReg31 >> 2) & 0x7) {
+                       case INCA_SWITCH_PHY_SPEED_10H:
+                               /* 10Base-T Half-duplex */
+                               regEphy = 0;
+                               break;
+                       case INCA_SWITCH_PHY_SPEED_10F:
+                               /* 10Base-T Full-duplex */
+                               regEphy = INCA_IP_Switch_EPHY_DL;
+                               break;
+                       case INCA_SWITCH_PHY_SPEED_100H:
+                               /* 100Base-TX Half-duplex */
+                               regEphy = INCA_IP_Switch_EPHY_SL;
+                               break;
+                       case INCA_SWITCH_PHY_SPEED_100F:
+                               /* 100Base-TX Full-duplex */
+                               regEphy = INCA_IP_Switch_EPHY_SL | INCA_IP_Switch_EPHY_DL;
+                               break;
+                       }
+
+                       /* In case of Auto-negotiation,
+                        * update the negotiated PAUSE support status
+                        */
+                       if (phyReg1 & (1 << 3)) {
+                               SW_WRITE_REG(INCA_IP_Switch_MDIO_ACC,
+                                       (0x1 << 31) |   /* RA           */
+                                       (0x0 << 30) |   /* Read         */
+                                       (0x6 << 21) |   /* LAN          */
+                                       (6   << 16));   /* PHY_ANER     */
+                               do {
+                                       SW_READ_REG(INCA_IP_Switch_MDIO_ACC, phyReg6);
+                               } while (phyReg6 & (1 << 31));
+
+                               /* We are Autoneg-able.
+                                * Is Link partner also able to autoneg?
+                                */
+                               if (phyReg6 & (1 << 0)) {
+                                       SW_WRITE_REG(INCA_IP_Switch_MDIO_ACC,
+                                               (0x1 << 31) |   /* RA           */
+                                               (0x0 << 30) |   /* Read         */
+                                               (0x6 << 21) |   /* LAN          */
+                                               (4   << 16));   /* PHY_ANAR     */
+                                       do {
+                                               SW_READ_REG(INCA_IP_Switch_MDIO_ACC, phyReg4);
+                                       } while (phyReg4 & (1 << 31));
+
+                                       /* We advertise PAUSE capab.
+                                        * Does link partner also advertise it?
+                                        */
+                                       if (phyReg4 & (1 << 10)) {
+                                               SW_WRITE_REG(INCA_IP_Switch_MDIO_ACC,
+                                                       (0x1 << 31) |   /* RA           */
+                                                       (0x0 << 30) |   /* Read         */
+                                                       (0x6 << 21) |   /* LAN          */
+                                                       (5   << 16));   /* PHY_ANLPAR   */
+                                               do {
+                                                       SW_READ_REG(INCA_IP_Switch_MDIO_ACC, phyReg5);
+                                               } while (phyReg5 & (1 << 31));
+
+                                               /* Link partner is PAUSE capab.
+                                                */
+                                               if (phyReg5 & (1 << 10)) {
+                                                       regEphy |= INCA_IP_Switch_EPHY_PL;
+                                               }
+                                       }
+                               }
+
+                       }
+
+                       /* Link is up */
+                       regEphy |= INCA_IP_Switch_EPHY_LL;
+
+                       SW_WRITE_REG(INCA_IP_Switch_EPHY, regEphy);
+               }
+       }
+
+       return 0;
+
+Fail:
+       printf("No Link on LAN port\n");
+       return -1;
+}
+#endif /* CONFIG_INCA_IP_SWITCH_AMDIX */
+
 #endif