/*
- * (C) Copyright 2007 Michal Simek
+ * (C) Copyright 2007-2009 Michal Simek
+ * (C) Copyright 2003 Xilinx Inc.
*
* Michal SIMEK <monstr@monstr.eu>
*
*
* 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
#include <common.h>
#include <net.h>
#include <config.h>
+#include <malloc.h>
#include <asm/io.h>
-#ifdef XILINX_EMACLITE_BASEADDR
-
-//#define DEBUG
+#undef DEBUG
#define ENET_MAX_MTU PKTSIZE
#define ENET_MAX_MTU_ALIGNED PKTSIZE_ALIGN
/* Recv interrupt enable bit */
#define XEL_RSR_RECV_IE_MASK 0x00000008UL
-typedef struct {
- unsigned int BaseAddress; /* Base address for device (IPIF) */
- unsigned int NextTxBufferToUse; /* Next TX buffer to write to */
- unsigned int NextRxBufferToUse; /* Next RX buffer to read from */
- unsigned char DeviceId; /* Unique ID of device - for future */
-} XEmacLite;
-
-static XEmacLite EmacLite;
+struct xemaclite {
+ u32 nexttxbuffertouse; /* Next TX buffer to write to */
+ u32 nextrxbuffertouse; /* Next RX buffer to read from */
+};
-static char etherrxbuff[PKTSIZE_ALIGN]; /* Receive buffer */
+static u32 etherrxbuff[PKTSIZE_ALIGN/4]; /* Receive buffer */
-/* hardcoded MAC address for the Xilinx EMAC Core when env is nowhere*/
-#ifdef CFG_ENV_IS_NOWHERE
-static u8 EMACAddr[ENET_ADDR_LENGTH] = { 0x00, 0x0a, 0x35, 0x00, 0x22, 0x01 };
-#endif
-
-void XEmacLite_AlignedRead (u32 * SrcPtr, void *DestPtr, unsigned ByteCount)
+static void xemaclite_alignedread (u32 *srcptr, void *destptr, u32 bytecount)
{
- unsigned i;
- unsigned Length = ByteCount;
- u32 AlignBuffer;
- u32 *To32Ptr;
- u32 *From32Ptr;
- u8 *To8Ptr;
- u8 *From8Ptr;
+ u32 i;
+ u32 alignbuffer;
+ u32 *to32ptr;
+ u32 *from32ptr;
+ u8 *to8ptr;
+ u8 *from8ptr;
- From32Ptr = (u32 *) SrcPtr;
+ from32ptr = (u32 *) srcptr;
/* Word aligned buffer, no correction needed. */
- To32Ptr = (u32 *) DestPtr;
- while (Length > 3) {
- *To32Ptr++ = *From32Ptr++;
- Length -= 4;
+ to32ptr = (u32 *) destptr;
+ while (bytecount > 3) {
+ *to32ptr++ = *from32ptr++;
+ bytecount -= 4;
}
- To8Ptr = (u8 *) To32Ptr;
+ to8ptr = (u8 *) to32ptr;
- AlignBuffer = *From32Ptr++;
- From8Ptr = (u8 *) & AlignBuffer;
+ alignbuffer = *from32ptr++;
+ from8ptr = (u8 *) & alignbuffer;
- for (i = 0; i < Length; i++) {
- *To8Ptr++ = *From8Ptr++;
+ for (i = 0; i < bytecount; i++) {
+ *to8ptr++ = *from8ptr++;
}
}
-void XEmacLite_AlignedWrite (void *SrcPtr, u32 * DestPtr, unsigned ByteCount)
+static void xemaclite_alignedwrite (void *srcptr, u32 destptr, u32 bytecount)
{
- unsigned i;
- unsigned Length = ByteCount;
- u32 AlignBuffer;
- u32 *To32Ptr;
- u32 *From32Ptr;
- u8 *To8Ptr;
- u8 *From8Ptr;
- To32Ptr = DestPtr;
-
- From32Ptr = (u32 *) SrcPtr;
- while (Length > 3) {
-
- *To32Ptr++ = *From32Ptr++;
- Length -= 4;
+ u32 i;
+ u32 alignbuffer;
+ u32 *to32ptr = (u32 *) destptr;
+ u32 *from32ptr;
+ u8 *to8ptr;
+ u8 *from8ptr;
+
+ from32ptr = (u32 *) srcptr;
+ while (bytecount > 3) {
+
+ *to32ptr++ = *from32ptr++;
+ bytecount -= 4;
}
- AlignBuffer = 0;
- To8Ptr = (u8 *) & AlignBuffer;
- From8Ptr = (u8 *) From32Ptr;
+ alignbuffer = 0;
+ to8ptr = (u8 *) & alignbuffer;
+ from8ptr = (u8 *) from32ptr;
- for (i = 0; i < Length; i++) {
- *To8Ptr++ = *From8Ptr++;
+ for (i = 0; i < bytecount; i++) {
+ *to8ptr++ = *from8ptr++;
}
- *To32Ptr++ = AlignBuffer;
+ *to32ptr++ = alignbuffer;
}
-void eth_halt (void)
+static void emaclite_halt(struct eth_device *dev)
{
-#ifdef DEBUG
- puts ("eth_halt\n");
-#endif
+ debug ("eth_halt\n");
}
-int eth_init (bd_t * bis)
+static int emaclite_init(struct eth_device *dev, bd_t *bis)
{
-#ifdef DEBUG
- puts ("EmacLite Initialization Started\n");
-#endif
- memset (&EmacLite, 0, sizeof (XEmacLite));
- EmacLite.BaseAddress = XILINX_EMACLITE_BASEADDR;
+ debug ("EmacLite Initialization Started\n");
-#ifdef CFG_ENV_IS_NOWHERE
- memcpy (bis->bi_enetaddr, EMACAddr, ENET_ADDR_LENGTH);
-#endif
/*
* TX - TX_PING & TX_PONG initialization
*/
/* Restart PING TX */
- out_be32 (EmacLite.BaseAddress + XEL_TSR_OFFSET, 0);
+ out_be32 (dev->iobase + XEL_TSR_OFFSET, 0);
/* Copy MAC address */
- XEmacLite_AlignedWrite (bis->bi_enetaddr,
- EmacLite.BaseAddress, ENET_ADDR_LENGTH);
+ xemaclite_alignedwrite (dev->enetaddr,
+ dev->iobase, ENET_ADDR_LENGTH);
/* Set the length */
- out_be32 (EmacLite.BaseAddress + XEL_TPLR_OFFSET, ENET_ADDR_LENGTH);
+ out_be32 (dev->iobase + XEL_TPLR_OFFSET, ENET_ADDR_LENGTH);
/* Update the MAC address in the EMAC Lite */
- out_be32 (EmacLite.BaseAddress + XEL_TSR_OFFSET, XEL_TSR_PROG_MAC_ADDR);
+ out_be32 (dev->iobase + XEL_TSR_OFFSET, XEL_TSR_PROG_MAC_ADDR);
/* Wait for EMAC Lite to finish with the MAC address update */
- while ((in_be32 (EmacLite.BaseAddress + XEL_TSR_OFFSET) &
- XEL_TSR_PROG_MAC_ADDR) != 0) ;
+ while ((in_be32 (dev->iobase + XEL_TSR_OFFSET) &
+ XEL_TSR_PROG_MAC_ADDR) != 0)
+ ;
-#ifdef XILINX_EMACLITE_TX_PING_PONG
+#ifdef CONFIG_XILINX_EMACLITE_TX_PING_PONG
/* The same operation with PONG TX */
- out_be32 (EmacLite.BaseAddress + XEL_TSR_OFFSET + XEL_BUFFER_OFFSET, 0);
- XEmacLite_AlignedWrite (bis->bi_enetaddr,
- EmacLite.BaseAddress + XEL_BUFFER_OFFSET, ENET_ADDR_LENGTH);
- out_be32 (EmacLite.BaseAddress + XEL_TPLR_OFFSET, ENET_ADDR_LENGTH);
- out_be32 (EmacLite.BaseAddress + XEL_TSR_OFFSET + XEL_BUFFER_OFFSET,
+ out_be32 (dev->iobase + XEL_TSR_OFFSET + XEL_BUFFER_OFFSET, 0);
+ xemaclite_alignedwrite(dev->enetaddr, dev->iobase +
+ XEL_BUFFER_OFFSET, ENET_ADDR_LENGTH);
+ out_be32 (dev->iobase + XEL_TPLR_OFFSET, ENET_ADDR_LENGTH);
+ out_be32 (dev->iobase + XEL_TSR_OFFSET + XEL_BUFFER_OFFSET,
XEL_TSR_PROG_MAC_ADDR);
- while ((in_be32 (EmacLite.BaseAddress + XEL_TSR_OFFSET +
- XEL_BUFFER_OFFSET) & XEL_TSR_PROG_MAC_ADDR) != 0) ;
+ while ((in_be32 (dev->iobase + XEL_TSR_OFFSET +
+ XEL_BUFFER_OFFSET) & XEL_TSR_PROG_MAC_ADDR) != 0)
+ ;
#endif
/*
* RX - RX_PING & RX_PONG initialization
*/
/* Write out the value to flush the RX buffer */
- out_be32 (EmacLite.BaseAddress + XEL_RSR_OFFSET, XEL_RSR_RECV_IE_MASK);
-#ifdef XILINX_EMACLITE_RX_PING_PONG
- out_be32 (EmacLite.BaseAddress + XEL_RSR_OFFSET + XEL_BUFFER_OFFSET,
+ out_be32 (dev->iobase + XEL_RSR_OFFSET, XEL_RSR_RECV_IE_MASK);
+#ifdef CONFIG_XILINX_EMACLITE_RX_PING_PONG
+ out_be32 (dev->iobase + XEL_RSR_OFFSET + XEL_BUFFER_OFFSET,
XEL_RSR_RECV_IE_MASK);
#endif
-#ifdef DEBUG
- puts ("EmacLite Initialization complete\n");
-#endif
+ debug ("EmacLite Initialization complete\n");
return 0;
}
-int XEmacLite_TxBufferAvailable (XEmacLite * InstancePtr)
+static int xemaclite_txbufferavailable(struct eth_device *dev)
{
- u32 Register;
- u32 TxPingBusy;
- u32 TxPongBusy;
+ u32 reg;
+ u32 txpingbusy;
+ u32 txpongbusy;
+ struct xemaclite *emaclite = dev->priv;
+
/*
* Read the other buffer register
* and determine if the other buffer is available
*/
- Register = in_be32 (InstancePtr->BaseAddress +
- InstancePtr->NextTxBufferToUse + 0);
- TxPingBusy = ((Register & XEL_TSR_XMIT_BUSY_MASK) ==
+ reg = in_be32 (dev->iobase +
+ emaclite->nexttxbuffertouse + 0);
+ txpingbusy = ((reg & XEL_TSR_XMIT_BUSY_MASK) ==
XEL_TSR_XMIT_BUSY_MASK);
- Register = in_be32 (InstancePtr->BaseAddress +
- (InstancePtr->NextTxBufferToUse ^ XEL_TSR_OFFSET) + 0);
- TxPongBusy = ((Register & XEL_TSR_XMIT_BUSY_MASK) ==
+ reg = in_be32 (dev->iobase +
+ (emaclite->nexttxbuffertouse ^ XEL_TSR_OFFSET) + 0);
+ txpongbusy = ((reg & XEL_TSR_XMIT_BUSY_MASK) ==
XEL_TSR_XMIT_BUSY_MASK);
- return (!(TxPingBusy && TxPongBusy));
+ return (!(txpingbusy && txpongbusy));
}
-int eth_send (volatile void *ptr, int len) {
-
- unsigned int Register;
- unsigned int BaseAddress;
+static int emaclite_send (struct eth_device *dev, volatile void *ptr, int len)
+{
+ u32 reg;
+ u32 baseaddress;
+ struct xemaclite *emaclite = dev->priv;
- unsigned maxtry = 1000;
+ u32 maxtry = 1000;
if (len > ENET_MAX_MTU)
len = ENET_MAX_MTU;
- while (!XEmacLite_TxBufferAvailable (&EmacLite) && maxtry) {
+ while (!xemaclite_txbufferavailable(dev) && maxtry) {
udelay (10);
maxtry--;
}
if (!maxtry) {
printf ("Error: Timeout waiting for ethernet TX buffer\n");
/* Restart PING TX */
- out_be32 (EmacLite.BaseAddress + XEL_TSR_OFFSET, 0);
-#ifdef XILINX_EMACLITE_TX_PING_PONG
- out_be32 (EmacLite.BaseAddress + XEL_TSR_OFFSET +
+ out_be32 (dev->iobase + XEL_TSR_OFFSET, 0);
+#ifdef CONFIG_XILINX_EMACLITE_TX_PING_PONG
+ out_be32 (dev->iobase + XEL_TSR_OFFSET +
XEL_BUFFER_OFFSET, 0);
#endif
- return 0;
+ return -1;
}
/* Determine the expected TX buffer address */
- BaseAddress = (EmacLite.BaseAddress + EmacLite.NextTxBufferToUse);
+ baseaddress = (dev->iobase + emaclite->nexttxbuffertouse);
/* Determine if the expected buffer address is empty */
- Register = in_be32 (BaseAddress + XEL_TSR_OFFSET);
- if (((Register & XEL_TSR_XMIT_BUSY_MASK) == 0)
- && ((in_be32 ((BaseAddress) + XEL_TSR_OFFSET)
+ reg = in_be32 (baseaddress + XEL_TSR_OFFSET);
+ if (((reg & XEL_TSR_XMIT_BUSY_MASK) == 0)
+ && ((in_be32 ((baseaddress) + XEL_TSR_OFFSET)
& XEL_TSR_XMIT_ACTIVE_MASK) == 0)) {
-#ifdef XILINX_EMACLITE_TX_PING_PONG
- EmacLite.NextTxBufferToUse ^= XEL_BUFFER_OFFSET;
-#endif
-#ifdef DEBUG
- printf ("Send packet from 0x%x\n", BaseAddress);
+#ifdef CONFIG_XILINX_EMACLITE_TX_PING_PONG
+ emaclite->nexttxbuffertouse ^= XEL_BUFFER_OFFSET;
#endif
+ debug ("Send packet from 0x%x\n", baseaddress);
/* Write the frame to the buffer */
- XEmacLite_AlignedWrite (ptr, (u32 *) BaseAddress, len);
- out_be32 (BaseAddress + XEL_TPLR_OFFSET,(len &
+ xemaclite_alignedwrite ((void *) ptr, baseaddress, len);
+ out_be32 (baseaddress + XEL_TPLR_OFFSET,(len &
(XEL_TPLR_LENGTH_MASK_HI | XEL_TPLR_LENGTH_MASK_LO)));
- Register = in_be32 (BaseAddress + XEL_TSR_OFFSET);
- Register |= XEL_TSR_XMIT_BUSY_MASK;
- if ((Register & XEL_TSR_XMIT_IE_MASK) != 0) {
- Register |= XEL_TSR_XMIT_ACTIVE_MASK;
+ reg = in_be32 (baseaddress + XEL_TSR_OFFSET);
+ reg |= XEL_TSR_XMIT_BUSY_MASK;
+ if ((reg & XEL_TSR_XMIT_IE_MASK) != 0) {
+ reg |= XEL_TSR_XMIT_ACTIVE_MASK;
}
- out_be32 (BaseAddress + XEL_TSR_OFFSET, Register);
- return 1;
+ out_be32 (baseaddress + XEL_TSR_OFFSET, reg);
+ return 0;
}
-#ifdef XILINX_EMACLITE_TX_PING_PONG
+#ifdef CONFIG_XILINX_EMACLITE_TX_PING_PONG
/* Switch to second buffer */
- BaseAddress ^= XEL_BUFFER_OFFSET;
+ baseaddress ^= XEL_BUFFER_OFFSET;
/* Determine if the expected buffer address is empty */
- Register = in_be32 (BaseAddress + XEL_TSR_OFFSET);
- if (((Register & XEL_TSR_XMIT_BUSY_MASK) == 0)
- && ((in_be32 ((BaseAddress) + XEL_TSR_OFFSET)
+ reg = in_be32 (baseaddress + XEL_TSR_OFFSET);
+ if (((reg & XEL_TSR_XMIT_BUSY_MASK) == 0)
+ && ((in_be32 ((baseaddress) + XEL_TSR_OFFSET)
& XEL_TSR_XMIT_ACTIVE_MASK) == 0)) {
-#ifdef DEBUG
- printf ("Send packet from 0x%x\n", BaseAddress);
-#endif
+ debug("Send packet from 0x%x\n", baseaddress);
/* Write the frame to the buffer */
- XEmacLite_AlignedWrite (ptr, (u32 *) BaseAddress, len);
- out_be32 (BaseAddress + XEL_TPLR_OFFSET,(len &
+ xemaclite_alignedwrite ((void *) ptr, baseaddress, len);
+ out_be32 (baseaddress + XEL_TPLR_OFFSET,(len &
(XEL_TPLR_LENGTH_MASK_HI | XEL_TPLR_LENGTH_MASK_LO)));
- Register = in_be32 (BaseAddress + XEL_TSR_OFFSET);
- Register |= XEL_TSR_XMIT_BUSY_MASK;
- if ((Register & XEL_TSR_XMIT_IE_MASK) != 0) {
- Register |= XEL_TSR_XMIT_ACTIVE_MASK;
+ reg = in_be32 (baseaddress + XEL_TSR_OFFSET);
+ reg |= XEL_TSR_XMIT_BUSY_MASK;
+ if ((reg & XEL_TSR_XMIT_IE_MASK) != 0) {
+ reg |= XEL_TSR_XMIT_ACTIVE_MASK;
}
- out_be32 (BaseAddress + XEL_TSR_OFFSET, Register);
- return 1;
+ out_be32 (baseaddress + XEL_TSR_OFFSET, reg);
+ return 0;
}
#endif
puts ("Error while sending frame\n");
- return 0;
+ return -1;
}
-int eth_rx (void)
+static int emaclite_recv(struct eth_device *dev)
{
- unsigned int Length;
- unsigned int Register;
- unsigned int BaseAddress;
-
- BaseAddress = EmacLite.BaseAddress + EmacLite.NextRxBufferToUse;
- Register = in_be32 (BaseAddress + XEL_RSR_OFFSET);
-#ifdef DEBUG
-// printf ("Testing data at address 0x%x\n", BaseAddress);
-#endif
- if ((Register & XEL_RSR_RECV_DONE_MASK) == XEL_RSR_RECV_DONE_MASK) {
-#ifdef XILINX_EMACLITE_RX_PING_PONG
- EmacLite.NextRxBufferToUse ^= XEL_BUFFER_OFFSET;
+ u32 length;
+ u32 reg;
+ u32 baseaddress;
+ struct xemaclite *emaclite = dev->priv;
+
+ baseaddress = dev->iobase + emaclite->nextrxbuffertouse;
+ reg = in_be32 (baseaddress + XEL_RSR_OFFSET);
+ debug ("Testing data at address 0x%x\n", baseaddress);
+ if ((reg & XEL_RSR_RECV_DONE_MASK) == XEL_RSR_RECV_DONE_MASK) {
+#ifdef CONFIG_XILINX_EMACLITE_RX_PING_PONG
+ emaclite->nextrxbuffertouse ^= XEL_BUFFER_OFFSET;
#endif
} else {
-#ifndef XILINX_EMACLITE_RX_PING_PONG
-#ifdef DEBUG
-// printf ("No data was available - address 0x%x\n", BaseAddress);
-#endif
+#ifndef CONFIG_XILINX_EMACLITE_RX_PING_PONG
+ debug ("No data was available - address 0x%x\n", baseaddress);
return 0;
#else
- BaseAddress ^= XEL_BUFFER_OFFSET;
- Register = in_be32 (BaseAddress + XEL_RSR_OFFSET);
- if ((Register & XEL_RSR_RECV_DONE_MASK) !=
+ baseaddress ^= XEL_BUFFER_OFFSET;
+ reg = in_be32 (baseaddress + XEL_RSR_OFFSET);
+ if ((reg & XEL_RSR_RECV_DONE_MASK) !=
XEL_RSR_RECV_DONE_MASK) {
-#ifdef DEBUG
-// printf ("No data was available - address 0x%x\n",
-// BaseAddress);
-#endif
+ debug ("No data was available - address 0x%x\n",
+ baseaddress);
return 0;
}
#endif
}
/* Get the length of the frame that arrived */
- switch(((in_be32(BaseAddress + XEL_RXBUFF_OFFSET + 0xC)) &
+ switch(((ntohl(in_be32 (baseaddress + XEL_RXBUFF_OFFSET + 0xC))) &
0xFFFF0000 ) >> 16) {
case 0x806:
- Length = 42 + 20; /* FIXME size of ARP */
-#ifdef DEBUG
- puts ("ARP Packet\n");
-#endif
+ length = 42 + 20; /* FIXME size of ARP */
+ debug ("ARP Packet\n");
break;
case 0x800:
- Length = 14 + 14 +
- (((in_be32(BaseAddress + XEL_RXBUFF_OFFSET + 0x10)) &
+ length = 14 + 14 +
+ (((ntohl(in_be32 (baseaddress + XEL_RXBUFF_OFFSET + 0x10))) &
0xFFFF0000) >> 16); /* FIXME size of IP packet */
-#ifdef DEBUG
- puts("IP Packet\n");
-#endif
+ debug ("IP Packet\n");
break;
default:
-#ifdef DEBUG
- puts("Other Packet\n");
-#endif
- Length = ENET_MAX_MTU;
+ debug ("Other Packet\n");
+ length = ENET_MAX_MTU;
break;
}
- XEmacLite_AlignedRead ((BaseAddress + XEL_RXBUFF_OFFSET),
- etherrxbuff, Length);
+ xemaclite_alignedread ((u32 *) (baseaddress + XEL_RXBUFF_OFFSET),
+ etherrxbuff, length);
/* Acknowledge the frame */
- Register = in_be32 (BaseAddress + XEL_RSR_OFFSET);
- Register &= ~XEL_RSR_RECV_DONE_MASK;
- out_be32 (BaseAddress + XEL_RSR_OFFSET, Register);
+ reg = in_be32 (baseaddress + XEL_RSR_OFFSET);
+ reg &= ~XEL_RSR_RECV_DONE_MASK;
+ out_be32 (baseaddress + XEL_RSR_OFFSET, reg);
-#ifdef DEBUG
- printf ("Packet receive from 0x%x, length %dB\n", BaseAddress, Length);
-#endif
- NetReceive ((uchar *) etherrxbuff, Length);
- return 1;
+ debug ("Packet receive from 0x%x, length %dB\n", baseaddress, length);
+ NetReceive ((uchar *) etherrxbuff, length);
+ return length;
}
-#endif
+
+int xilinx_emaclite_initialize (bd_t *bis, int base_addr)
+{
+ struct eth_device *dev;
+ struct xemaclite *emaclite;
+
+ dev = calloc(1, sizeof(*dev));
+ if (dev == NULL)
+ return -1;
+
+ emaclite = calloc(1, sizeof(struct xemaclite));
+ if (emaclite == NULL) {
+ free(dev);
+ return -1;
+ }
+
+ dev->priv = emaclite;
+
+ sprintf(dev->name, "Xelite.%x", base_addr);
+
+ dev->iobase = base_addr;
+ dev->init = emaclite_init;
+ dev->halt = emaclite_halt;
+ dev->send = emaclite_send;
+ dev->recv = emaclite_recv;
+
+ eth_register(dev);
+
+ return 1;
+}