* Cleanup lowboot code for MPC5200
[pandora-u-boot.git] / cpu / coldfire / fec.c
index 53a93c1..5062741 100644 (file)
@@ -27,7 +27,6 @@
 #include <command.h>
 
 
-
 /**************************************************************
  *
  * FEC Ethernet Initialization Routine
 #define        FEC_RESET_DELAY         50000
 
 
-
 /* Ethernet Transmit and Receive Buffers */
 #define DBUF_LENGTH  1520
-
 #define TX_BUF_CNT 2
-
 #define TOUT_LOOP 100
 
-#define PKT_MAXBUF_SIZE         1518
-#define PKT_MINBUF_SIZE         64
-#define PKT_MAXBLR_SIZE         1520
-
+#define PKT_MAXBUF_SIZE                1518
+#define PKT_MINBUF_SIZE                64
+#define PKT_MAXBLR_SIZE                1520
 
 
 #ifdef CONFIG_M5272
 #if (CONFIG_COMMANDS & CFG_CMD_NET) && defined(FEC_ENET)
 
 
-
 static char txbuf[DBUF_LENGTH];
 
-static uint rxIdx;     /* index of the current RX buffer */
-static uint txIdx;     /* index of the current TX buffer */
+static uint rxIdx;             /* index of the current RX buffer */
+static uint txIdx;             /* index of the current TX buffer */
 
 /*
   * FEC Ethernet Tx and Rx buffer descriptors allocated at the
@@ -89,14 +83,14 @@ static uint txIdx;  /* index of the current TX buffer */
   */
 
 typedef volatile struct CommonBufferDescriptor {
-    cbd_t rxbd[PKTBUFSRX];             /* Rx BD */
-    cbd_t txbd[TX_BUF_CNT];            /* Tx BD */
+       cbd_t rxbd[PKTBUFSRX];  /* Rx BD */
+       cbd_t txbd[TX_BUF_CNT]; /* Tx BD */
 } RTXBD;
 
 static RTXBD *rtx = 0x380000;
 
 
-int eth_send(volatile void *packet, int length)
+int eth_send (volatile void *packet, int length)
 {
        int j, rc;
        volatile fec_t *fecp = FEC_ADDR;
@@ -105,35 +99,37 @@ int eth_send(volatile void *packet, int length)
         * Wait for ready
         */
        j = 0;
-       while ((rtx->txbd[txIdx].cbd_sc & BD_ENET_TX_READY) && (j<TOUT_LOOP)) {
-               udelay(1);
+       while ((rtx->txbd[txIdx].cbd_sc & BD_ENET_TX_READY)
+              && (j < TOUT_LOOP)) {
+               udelay (1);
                j++;
        }
-       if (j>=TOUT_LOOP) {
-               printf("TX not ready\n");
+       if (j >= TOUT_LOOP) {
+               printf ("TX not ready\n");
        }
 
-       rtx->txbd[txIdx].cbd_bufaddr = (uint)packet;
-       rtx->txbd[txIdx].cbd_datlen  = length;
+       rtx->txbd[txIdx].cbd_bufaddr = (uint) packet;
+       rtx->txbd[txIdx].cbd_datlen = length;
        rtx->txbd[txIdx].cbd_sc |= BD_ENET_TX_READY | BD_ENET_TX_LAST;
 
        /* Activate transmit Buffer Descriptor polling */
-       fecp->fec_x_des_active = 0x01000000;    /* Descriptor polling active    */
+       fecp->fec_x_des_active = 0x01000000;    /* Descriptor polling active    */
 
        j = 0;
-       while ((rtx->txbd[txIdx].cbd_sc & BD_ENET_TX_READY) && (j<TOUT_LOOP)) {
-               udelay(1);
+       while ((rtx->txbd[txIdx].cbd_sc & BD_ENET_TX_READY)
+              && (j < TOUT_LOOP)) {
+               udelay (1);
                j++;
        }
-       if (j>=TOUT_LOOP) {
-               printf("TX timeout\n");
+       if (j >= TOUT_LOOP) {
+               printf ("TX timeout\n");
        }
 #ifdef ET_DEBUG
-       printf("%s[%d] %s: cycles: %d    status: %x  retry cnt: %d\n",
-       __FILE__,__LINE__,__FUNCTION__,j,rtx->txbd[txIdx].cbd_sc,
-       (rtx->txbd[txIdx].cbd_sc & 0x003C)>>2);
+       printf ("%s[%d] %s: cycles: %d    status: %x  retry cnt: %d\n",
+               __FILE__, __LINE__, __FUNCTION__, j, rtx->txbd[txIdx].cbd_sc,
+               (rtx->txbd[txIdx].cbd_sc & 0x003C) >> 2);
 #endif
-       /* return only status bits */;
+       /* return only status bits */ ;
        rc = (rtx->txbd[txIdx].cbd_sc & BD_ENET_TX_STATS);
 
        txIdx = (txIdx + 1) % TX_BUF_CNT;
@@ -141,48 +137,49 @@ int eth_send(volatile void *packet, int length)
        return rc;
 }
 
-int eth_rx(void)
+int eth_rx (void)
 {
        int length;
        volatile fec_t *fecp = FEC_ADDR;
 
-   for (;;)
-   {     
-       /* section 16.9.23.2 */
-       if (rtx->rxbd[rxIdx].cbd_sc & BD_ENET_RX_EMPTY) {
-               length = -1;
-               break;     /* nothing received - leave for() loop */
-       }
+       for (;;) {
+               /* section 16.9.23.2 */
+               if (rtx->rxbd[rxIdx].cbd_sc & BD_ENET_RX_EMPTY) {
+                       length = -1;
+                       break;  /* nothing received - leave for() loop */
+               }
 
-       length = rtx->rxbd[rxIdx].cbd_datlen;
+               length = rtx->rxbd[rxIdx].cbd_datlen;
 
-       if (rtx->rxbd[rxIdx].cbd_sc & 0x003f) {
+               if (rtx->rxbd[rxIdx].cbd_sc & 0x003f) {
 #ifdef ET_DEBUG
-               printf("%s[%d] err: %x\n",
-               __FUNCTION__,__LINE__,rtx->rxbd[rxIdx].cbd_sc);
+                       printf ("%s[%d] err: %x\n",
+                               __FUNCTION__, __LINE__,
+                               rtx->rxbd[rxIdx].cbd_sc);
 #endif
-       } else {
-               /* Pass the packet up to the protocol layers. */
-               NetReceive(NetRxPackets[rxIdx], length - 4);
+               } else {
+                       /* Pass the packet up to the protocol layers. */
+                       NetReceive (NetRxPackets[rxIdx], length - 4);
+               }
+
+               /* Give the buffer back to the FEC. */
+               rtx->rxbd[rxIdx].cbd_datlen = 0;
+
+               /* wrap around buffer index when necessary */
+               if ((rxIdx + 1) >= PKTBUFSRX) {
+                       rtx->rxbd[PKTBUFSRX - 1].cbd_sc =
+                               (BD_ENET_RX_WRAP | BD_ENET_RX_EMPTY);
+                       rxIdx = 0;
+               } else {
+                       rtx->rxbd[rxIdx].cbd_sc = BD_ENET_RX_EMPTY;
+                       rxIdx++;
+               }
+
+               /* Try to fill Buffer Descriptors */
+               fecp->fec_r_des_active = 0x01000000;    /* Descriptor polling active    */
        }
 
-       /* Give the buffer back to the FEC. */
-       rtx->rxbd[rxIdx].cbd_datlen = 0;
-
-       /* wrap around buffer index when necessary */
-       if ((rxIdx + 1) >= PKTBUFSRX) {
-           rtx->rxbd[PKTBUFSRX - 1].cbd_sc = (BD_ENET_RX_WRAP | BD_ENET_RX_EMPTY);
-          rxIdx = 0;
-       } else {
-           rtx->rxbd[rxIdx].cbd_sc = BD_ENET_RX_EMPTY;
-          rxIdx++;
-       }
-       
-       /* Try to fill Buffer Descriptors */
-       fecp->fec_r_des_active = 0x01000000;    /* Descriptor polling active    */
-   }
-
-   return length;
+       return length;
 }
 
 
@@ -191,7 +188,7 @@ int eth_init (bd_t * bd)
 
        int i;
        volatile fec_t *fecp = FEC_ADDR;
-       
+
        /* Whack a reset.
         * A delay is required between a reset of the FEC block and
         * initialization of other FEC registers because the reset takes
@@ -214,21 +211,21 @@ int eth_init (bd_t * bd)
        /* We use strictly polling mode only
         */
        fecp->fec_imask = 0;
-       
+
        /* Clear any pending interrupt */
        fecp->fec_ievent = 0xffffffff;
-       
-       /* Set station address   */
+
+       /* Set station address   */
 #define ea bd->bi_enetaddr
-       fecp->fec_addr_low   =  (ea[0] << 24) | (ea[1] << 16) |
-                               (ea[2] <<  8) | (ea[3]        ) ;
-       fecp->fec_addr_high  =  (ea[4] << 24) | (ea[5] << 16  ) ;
+       fecp->fec_addr_low = (ea[0] << 24) | (ea[1] << 16) |
+               (ea[2] << 8) | (ea[3]);
+       fecp->fec_addr_high = (ea[4] << 24) | (ea[5] << 16);
 #undef ea
 
        /* Clear multicast address hash table
         */
        fecp->fec_hash_table_high = 0;
-       fecp->fec_hash_table_low  = 0;
+       fecp->fec_hash_table_low = 0;
 
        /* Set maximum receive buffer size.
         */
@@ -246,8 +243,8 @@ int eth_init (bd_t * bd)
         *     Empty, Wrap
         */
        for (i = 0; i < PKTBUFSRX; i++) {
-               rtx->rxbd[i].cbd_sc      = BD_ENET_RX_EMPTY;
-               rtx->rxbd[i].cbd_datlen  = 0;   /* Reset */
+               rtx->rxbd[i].cbd_sc = BD_ENET_RX_EMPTY;
+               rtx->rxbd[i].cbd_datlen = 0;    /* Reset */
                rtx->rxbd[i].cbd_bufaddr = (uint) NetRxPackets[i];
        }
        rtx->rxbd[PKTBUFSRX - 1].cbd_sc |= BD_ENET_RX_WRAP;
@@ -258,8 +255,8 @@ int eth_init (bd_t * bd)
         *    Last, Tx CRC
         */
        for (i = 0; i < TX_BUF_CNT; i++) {
-               rtx->txbd[i].cbd_sc      = BD_ENET_TX_LAST | BD_ENET_TX_TC;
-               rtx->txbd[i].cbd_datlen  = 0;   /* Reset */
+               rtx->txbd[i].cbd_sc = BD_ENET_TX_LAST | BD_ENET_TX_TC;
+               rtx->txbd[i].cbd_datlen = 0;    /* Reset */
                rtx->txbd[i].cbd_bufaddr = (uint) (&txbuf[0]);
        }
        rtx->txbd[TX_BUF_CNT - 1].cbd_sc |= BD_ENET_TX_WRAP;
@@ -273,8 +270,8 @@ int eth_init (bd_t * bd)
         */
 
        /* Half duplex mode */
-       fecp->fec_r_cntrl = (PKT_MAXBUF_SIZE<<16) | FEC_RCNTRL_MII_MODE;
-       fecp->fec_r_cntrl = (PKT_MAXBUF_SIZE<<16) | FEC_RCNTRL_MII_MODE;
+       fecp->fec_r_cntrl = (PKT_MAXBUF_SIZE << 16) | FEC_RCNTRL_MII_MODE;
+       fecp->fec_r_cntrl = (PKT_MAXBUF_SIZE << 16) | FEC_RCNTRL_MII_MODE;
        fecp->fec_x_cntrl = 0;
 
        fecp->fec_mii_speed = 0;
@@ -284,17 +281,16 @@ int eth_init (bd_t * bd)
        fecp->fec_ecntrl = FEC_ECNTRL_ETHER_EN;
 
        /* And last, try to fill Rx Buffer Descriptors */
-       fecp->fec_r_des_active = 0x01000000;    /* Descriptor polling active    */
+       fecp->fec_r_des_active = 0x01000000;    /* Descriptor polling active    */
 
        return 1;
 }
 
 
-
-void eth_halt(void)
+void eth_halt (void)
 {
        volatile fec_t *fecp = FEC_ADDR;
+
        fecp->fec_ecntrl = 0;
 }
-
 #endif