| Line 6... |
Line 6... |
#include "uart.h"
|
#include "uart.h"
|
#include "eth.h"
|
#include "eth.h"
|
#include "int.h"
|
#include "int.h"
|
#include "spr_defs.h"
|
#include "spr_defs.h"
|
|
|
|
//#define PRINT_PACKETS
|
|
//#define ETHPHY_10MBPS
|
|
|
extern int printf (const char *fmt, ...);
|
extern int printf (const char *fmt, ...);
|
extern void lolev_ie(void);
|
extern void lolev_ie(void);
|
extern void lolev_idis(void);
|
extern void lolev_idis(void);
|
|
|
int tx_next; /* Next buffer to be given to the user */
|
int tx_next; /* Next buffer to be given to the user */
|
int tx_last; /* Next buffer to be checked if packet sent */
|
int tx_last; /* Next buffer to be checked if packet sent */
|
int tx_full;
|
int tx_full;
|
int rx_next; /* Next buffer to be checked for new packet and given to the user */
|
int rx_next; /* Next buffer to be checked for new packet and given to the user */
|
void (*receive)(volatile unsigned char *add, int len); /* Pointer to function to be called
|
void (*receive)(volatile unsigned char *add, int len); /* Pointer to function to be called
|
when frame is received */
|
when frame is received */
|
|
int eth_monitor_enabled;
|
|
|
|
//unsigned long eth_data[((ETH_TXBD_NUM + ETH_RXBD_NUM) * ETH_MAXBUF_LEN)/4] = {0};
|
|
//#undef ETH_DATA_BASE
|
|
//#define ETH_DATA_BASE ((unsigned long)eth_data)
|
|
|
unsigned long eth_data[((ETH_TXBD_NUM + ETH_RXBD_NUM) * ETH_MAXBUF_LEN)/4] = {0};
|
|
#undef ETH_DATA_BASE
|
|
#define ETH_DATA_BASE ((unsigned long)eth_data)
|
|
|
|
static void
|
static void
|
print_packet(unsigned long add, int len)
|
print_packet(unsigned long add, int len)
|
{
|
{
|
int i;
|
int i;
|
|
|
printf("ipacket: add = %lx len = %d\n", add, len);
|
printf("ipacket: add = %lx len = %d\n", add, len);
|
for(i = 0; i < len; i++) {
|
for(i = 0; i < len; i++) {
|
if(!(i % 16))
|
if(!(i % 16)) printf("\n");
|
printf("\n");
|
else if(!(i % 8)) printf(" "); // space here, so output is like wireshark
|
printf(" %.2x", *(((unsigned char *)add) + i));
|
printf(" %.2x", *(((unsigned char *)add) + i));
|
}
|
}
|
printf("\n");
|
printf("\n");
|
}
|
}
|
|
|
| Line 72... |
Line 77... |
}
|
}
|
|
|
bd[i-1].len_status |= ETH_RX_BD_WRAP; // Last Rx BD - Wrap
|
bd[i-1].len_status |= ETH_RX_BD_WRAP; // Last Rx BD - Wrap
|
}
|
}
|
|
|
|
|
|
void eth_traffic_monitor(void)
|
|
{
|
|
volatile oeth_regs *regs;
|
|
regs = (oeth_regs *)(ETH_REG_BASE);
|
|
|
|
uint int_events;
|
|
int serviced;
|
|
int i;
|
|
|
|
serviced = 0;
|
|
|
|
/* Get the interrupt events that caused us to be here.
|
|
*/
|
|
int_events = regs->int_src;
|
|
regs->int_src = int_events;
|
|
|
|
printf("\n=tx_ | %x | %x | %x | %x | %x | %x | %x | %x\n",
|
|
((oeth_bd *)(ETH_BD_BASE))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+8))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+16))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+24))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+32))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+40))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+48))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+56))->len_status);
|
|
|
|
printf("=rx_ | %x | %x | %x | %x | %x | %x | %x | %x\n",
|
|
((oeth_bd *)(ETH_BD_BASE+64))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+64+8))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+64+16))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+64+24))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+64+32))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+64+40))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+64+48))->len_status,
|
|
((oeth_bd *)(ETH_BD_BASE+64+56))->len_status);
|
|
|
|
printf("=int | txb %d | txe %d | rxb %d | rxe %d | busy %d\n",
|
|
(int_events & ETH_INT_TXB) > 0,
|
|
(int_events & ETH_INT_TXE) > 0,
|
|
(int_events & ETH_INT_RXF) > 0,
|
|
(int_events & ETH_INT_RXE) > 0,
|
|
(int_events & ETH_INT_BUSY) > 0);
|
|
|
|
|
|
/* Check for receive busy, i.e. packets coming but no place to
|
|
* put them.
|
|
*/
|
|
if (int_events & ETH_INT_BUSY ) {
|
|
serviced |= 0x4;
|
|
printf("eth: busy!");
|
|
}
|
|
|
|
/* Handle receive event
|
|
*/
|
|
if (int_events & (ETH_INT_RXF | ETH_INT_RXE)) {
|
|
serviced |= 0x1;
|
|
volatile oeth_bd *rx_bdp;
|
|
rx_bdp = ((oeth_bd *)ETH_BD_BASE) + ETH_TXBD_NUM;
|
|
/* Find RX buffers marked as having received data */
|
|
for(i = 0; i < ETH_RXBD_NUM; i++)
|
|
{
|
|
if(!(rx_bdp[i].len_status & ETH_RX_BD_EMPTY))
|
|
{
|
|
print_packet(rx_bdp[i].addr, rx_bdp[i].len_status >> 16);
|
|
rx_bdp[i].len_status &= ~ETH_RX_BD_STATS; /* Clear stats */
|
|
rx_bdp[i].len_status |= ETH_RX_BD_EMPTY; /* Mark RX BD as empty */
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Handle transmit event
|
|
*/
|
|
if (int_events & (ETH_INT_TXB | ETH_INT_TXE)) {
|
|
serviced |= 0x2;
|
|
volatile oeth_bd *tx_bd;
|
|
tx_bd = (volatile oeth_bd *)ETH_BD_BASE; /* Search from beginning*/
|
|
for(i = 0; i < ETH_TXBD_NUM; i++)
|
|
{
|
|
/* Looking for buffer NOT ready for transmit */
|
|
if((!(tx_bd[i].len_status & (ETH_TX_BD_READY))) &&
|
|
(tx_bd[i].len_status & (ETH_TX_BD_IRQ)))
|
|
{
|
|
print_packet(tx_bd[i].addr, (tx_bd[i].len_status >> 16));
|
|
tx_bd[i].len_status &= ~ETH_TX_BD_IRQ;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
if (serviced == 0)
|
|
printf("\neth interrupt called but nothing serviced\n");
|
|
|
|
}
|
|
|
|
|
/* Ethernet interrupt handler */
|
/* Ethernet interrupt handler */
|
void eth_int (void)
|
void eth_int (void)
|
{
|
{
|
|
printf("eth-int!\n");
|
|
if (eth_monitor_enabled)
|
|
eth_traffic_monitor();
|
|
//REG32(ETH_REG_BASE + ETH_INT) = 0xffffffff;
|
|
|
|
}
|
|
|
|
void eth_reset_phy(void)
|
|
{
|
|
/* Reset Eth PHY via MDIO*/
|
|
printf("Resetting PHY, waiting for link");
|
|
REG32(ETH_REG_BASE + ETH_MIIADDRESS) = (0<<8)|(ETH_MDIOPHYADDR&0xff);
|
|
REG32(ETH_REG_BASE + ETH_MIITX_DATA) = 0x8000; // Bit 15 = 1: RESET
|
|
REG32(ETH_REG_BASE + ETH_MIICOMMAND) = ETH_MIICOMMAND_WCTRLDATA;
|
|
while(REG32(ETH_REG_BASE + ETH_MIISTATUS) & ETH_MIISTATUS_BUSY);
|
|
|
|
sleep(100);
|
|
|
|
while(1){
|
|
printf(".");
|
|
REG32(ETH_REG_BASE + ETH_MIIADDRESS) = (0<<8)|(ETH_MDIOPHYADDR&0xff);
|
|
REG32(ETH_REG_BASE + ETH_MIICOMMAND) = ETH_MIICOMMAND_RSTAT;
|
|
while(REG32(ETH_REG_BASE + ETH_MIISTATUS) & ETH_MIISTATUS_BUSY);
|
|
if(!(REG32(ETH_REG_BASE + ETH_MIIRX_DATA) & 0x8000)) // If reset clear
|
|
break;
|
|
}
|
}
|
}
|
|
|
|
|
void eth_init (void (*rec)(volatile unsigned char *, int))
|
void eth_init (void (*rec)(volatile unsigned char *, int))
|
{
|
{
|
/* Reset ethernet core */
|
/* Reset ethernet core */
|
REG32(ETH_REG_BASE + ETH_MODER) = ETH_MODER_RST; /* Reset ON */
|
REG32(ETH_REG_BASE + ETH_MODER) = ETH_MODER_RST; /* Reset ON */
|
REG32(ETH_REG_BASE + ETH_MODER) &= ~ETH_MODER_RST; /* Reset OFF */
|
REG32(ETH_REG_BASE + ETH_MODER) &= ~ETH_MODER_RST; /* Reset OFF */
|
|
|
/* Setting TX BD number */
|
/* Setting TX BD number */
|
REG32(ETH_REG_BASE + ETH_TX_BD_NUM) = ETH_TXBD_NUM;
|
REG32(ETH_REG_BASE + ETH_TX_BD_NUM) = ETH_TXBD_NUM;
|
|
|
|
#ifdef ETHPHY_10MBPS
|
// Set PHY to 10 Mbps full duplex
|
// Set PHY to 10 Mbps full duplex
|
REG32(ETH_REG_BASE + ETH_MIIADDRESS) = 0<<8;
|
REG32(ETH_REG_BASE + ETH_MIIADDRESS) = 0<<8;
|
REG32(ETH_REG_BASE + ETH_MIITX_DATA) = 0x0100;
|
REG32(ETH_REG_BASE + ETH_MIITX_DATA) = 0x0100;
|
REG32(ETH_REG_BASE + ETH_MIICOMMAND) = ETH_MIICOMMAND_WCTRLDATA;
|
REG32(ETH_REG_BASE + ETH_MIICOMMAND) = ETH_MIICOMMAND_WCTRLDATA;
|
while(REG32(ETH_REG_BASE + ETH_MIISTATUS) & ETH_MIISTATUS_BUSY);
|
while(REG32(ETH_REG_BASE + ETH_MIISTATUS) & ETH_MIISTATUS_BUSY);
|
| Line 100... |
Line 229... |
while(REG32(ETH_REG_BASE + ETH_MIISTATUS) & ETH_MIISTATUS_BUSY);
|
while(REG32(ETH_REG_BASE + ETH_MIISTATUS) & ETH_MIISTATUS_BUSY);
|
if(REG32(ETH_REG_BASE + ETH_MIIRX_DATA) & 0x04)
|
if(REG32(ETH_REG_BASE + ETH_MIIRX_DATA) & 0x04)
|
break;
|
break;
|
}
|
}
|
|
|
|
#endif
|
|
|
/* Set min/max packet length */
|
/* Set min/max packet length */
|
REG32(ETH_REG_BASE + ETH_PACKETLEN) = 0x00400600;
|
REG32(ETH_REG_BASE + ETH_PACKETLEN) = 0x00400600;
|
|
|
/* Set IPGT register to recomended value */
|
/* Set IPGT register to recomended value */
|
REG32(ETH_REG_BASE + ETH_IPGT) = 0x00000012;
|
REG32(ETH_REG_BASE + ETH_IPGT) = 0x00000012;
|
| Line 116... |
Line 247... |
|
|
/* Set COLLCONF register to recomended value */
|
/* Set COLLCONF register to recomended value */
|
REG32(ETH_REG_BASE + ETH_COLLCONF) = 0x000f003f;
|
REG32(ETH_REG_BASE + ETH_COLLCONF) = 0x000f003f;
|
|
|
#if 0
|
#if 0
|
REG32(ETH_REG_BASE + ETH_CTRLMODER) = OETH_CTRLMODER_TXFLOW | OETH_CTRLMODER_RXFLOW;
|
REG32(ETH_REG_BASE + ETH_CTRLMODER) = ETH_CTRLMODER_TXFLOW | ETH_CTRLMODER_RXFLOW;
|
#else
|
#else
|
REG32(ETH_REG_BASE + ETH_CTRLMODER) = 0;
|
REG32(ETH_REG_BASE + ETH_CTRLMODER) = 0;
|
#endif
|
#endif
|
|
|
/* Initialize RX and TX buffer descriptors */
|
/* Initialize RX and TX buffer descriptors */
|
| Line 150... |
Line 281... |
/* Promisc, IFG, CRCEn */
|
/* Promisc, IFG, CRCEn */
|
REG32(ETH_REG_BASE + ETH_MODER) |= ETH_MODER_PAD | ETH_MODER_IFG | ETH_MODER_CRCEN;
|
REG32(ETH_REG_BASE + ETH_MODER) |= ETH_MODER_PAD | ETH_MODER_IFG | ETH_MODER_CRCEN;
|
|
|
/* Enable interrupt sources */
|
/* Enable interrupt sources */
|
#if 0
|
#if 0
|
regs->int_mask = ETH_INT_MASK_TXB |
|
REG32(ETH_REG_BASE + ETH_INT_MASK)= ETH_INT_MASK_TXB |
|
ETH_INT_MASK_TXE |
|
ETH_INT_MASK_TXE |
|
ETH_INT_MASK_RXF |
|
ETH_INT_MASK_RXF |
|
ETH_INT_MASK_RXE |
|
ETH_INT_MASK_RXE |
|
ETH_INT_MASK_BUSY |
|
ETH_INT_MASK_BUSY |
|
ETH_INT_MASK_TXC |
|
ETH_INT_MASK_TXC |
|
ETH_INT_MASK_RXC;
|
ETH_INT_MASK_RXC;
|
|
eth_monitor_enabled = 1;
|
#else
|
#else
|
REG32(ETH_REG_BASE + ETH_INT_MASK) = 0x00000000;
|
REG32(ETH_REG_BASE + ETH_INT_MASK) = 0x00000000;
|
|
printf("eth_init: monitor disabled at startup\n");
|
|
eth_monitor_enabled = 0;
|
#endif
|
#endif
|
|
|
/* Enable receiver and transmiter */
|
/* Enable receiver and transmiter */
|
REG32(ETH_REG_BASE + ETH_MODER) |= ETH_MODER_RXEN | ETH_MODER_TXEN;
|
REG32(ETH_REG_BASE + ETH_MODER) |= ETH_MODER_RXEN | ETH_MODER_TXEN;
|
|
|
| Line 197... |
Line 331... |
/* Send a packet at address */
|
/* Send a packet at address */
|
void eth_send (void *buf, unsigned long len)
|
void eth_send (void *buf, unsigned long len)
|
{
|
{
|
eth_bd *bd;
|
eth_bd *bd;
|
|
|
|
#ifdef PRINT_PACKETS
|
|
printf("transmitted packet:\t");
|
|
print_packet(buf, len);
|
|
#endif
|
|
|
bd = (eth_bd *)ETH_BD_BASE;
|
bd = (eth_bd *)ETH_BD_BASE;
|
|
|
bd[tx_last].addr = (unsigned long)buf;
|
bd[tx_last].addr = (unsigned long)buf;
|
|
retry_eth_send:
|
bd[tx_last].len_status &= 0x0000ffff & ~ETH_TX_BD_STATS;
|
bd[tx_last].len_status &= 0x0000ffff & ~ETH_TX_BD_STATS;
|
|
if (eth_monitor_enabled) // enable IRQ when sending
|
|
bd[tx_last].len_status |= ETH_TX_BD_IRQ;
|
bd[tx_last].len_status |= len << 16 | ETH_TX_BD_READY;
|
bd[tx_last].len_status |= len << 16 | ETH_TX_BD_READY;
|
|
|
|
/*
|
|
while (bd[tx_last].len_status & ETH_TX_BD_READY);
|
|
printf("packet tx\n");
|
|
// Check it was sent OK
|
|
if ( bd[tx_last].len_status & 0x2)
|
|
{
|
|
printf("eth_send: carrier sense lost (txbd: 0x%x), deferred, retrying\n",
|
|
bd[tx_last].len_status);
|
|
sleep(1000);
|
|
goto retry_eth_send;
|
|
}
|
|
*/
|
tx_last = (tx_last + 1) & ETH_TXBD_NUM_MASK;
|
tx_last = (tx_last + 1) & ETH_TXBD_NUM_MASK;
|
tx_full = 0;
|
tx_full = 0;
|
|
|
}
|
}
|
|
|
/* Waits for packet and pass it to the upper layers */
|
/* Waits for packet and pass it to the upper layers */
|
unsigned long eth_rx (void)
|
unsigned long eth_rx (void)
|
{
|
{
|
| Line 252... |
Line 407... |
printf("eth rx: ETH_RX_BD_LATECOL\n");
|
printf("eth rx: ETH_RX_BD_LATECOL\n");
|
bad = 1;
|
bad = 1;
|
}
|
}
|
|
|
if(!bad) {
|
if(!bad) {
|
|
#ifdef PRINT_PACKETS
|
|
printf("received packet:\t");
|
|
print_packet(bd[rx_next].addr, bd[rx_next].len_status >> 16);
|
|
#endif
|
receive((void *)bd[rx_next].addr, bd[rx_next].len_status >> 16);
|
receive((void *)bd[rx_next].addr, bd[rx_next].len_status >> 16);
|
len += bd[rx_next].len_status >> 16;
|
len += bd[rx_next].len_status >> 16;
|
}
|
}
|
|
|
bd[rx_next].len_status &= ~ETH_RX_BD_STATS;
|
bd[rx_next].len_status &= ~ETH_RX_BD_STATS;
|
| Line 274... |
Line 433... |
ETH_INT_MASK_BUSY |
|
ETH_INT_MASK_BUSY |
|
ETH_INT_MASK_TXC |
|
ETH_INT_MASK_TXC |
|
ETH_INT_MASK_RXC;
|
ETH_INT_MASK_RXC;
|
}
|
}
|
|
|
|
void eth_int_disable(void)
|
|
{
|
|
REG32(ETH_REG_BASE + ETH_INT_MASK) = 0;
|
|
}
|
|
|
void eth_halt(void)
|
void eth_halt(void)
|
{
|
{
|
/* Enable receiver and transmiter */
|
/* Disable receiver and transmiter */
|
REG32(ETH_REG_BASE + ETH_MODER) &= ~(ETH_MODER_RXEN | ETH_MODER_TXEN);
|
REG32(ETH_REG_BASE + ETH_MODER) &= ~(ETH_MODER_RXEN | ETH_MODER_TXEN);
|
}
|
}
|
|
|
|
|
|
void eth_toggle_traffic_mon(void)
|
|
{
|
|
if (!eth_monitor_enabled)
|
|
{
|
|
printf("eth_toggle_traffic_mon: traffic monitor ENABLED\n");
|
|
printf("eth_toggle_traffic_mon: Warning - do not enable during tftp boot!\n");
|
|
eth_monitor_enabled = 1;
|
|
eth_int_enable();
|
|
}
|
|
else
|
|
{
|
|
eth_int_disable();
|
|
eth_monitor_enabled = 0;
|
|
printf("eth_toggle_traffic_mon: traffic monitor DISABLED\n");
|
|
|
|
|
|
}
|
|
|
|
}
|
#endif
|
#endif
|
|
|
No newline at end of file
|
No newline at end of file
|
