Subversion Repositories wdsp

#include "../support/support.h"
#include "../support/board.h"
#include "../support/uart.h"
 
#include "../support/spr_defs.h"
 
#include "eth.h"
 
void uart_print_str(char *);
void uart_print_long(unsigned long);
 
// Dummy or32 except vectors
void buserr_except(){}
void dpf_except(){}
void ipf_except(){}
void lpint_except(){}
void align_except(){}
void illegal_except(){}
/*void hpint_except(){
 
}*/
void dtlbmiss_except(){}
void itlbmiss_except(){}
void range_except(){}
void syscall_except(){}
void res1_except(){}
void trap_except(){}
void res2_except(){}
 
 
void uart_interrupt()
{
    char lala;
    unsigned char interrupt_id;
    interrupt_id = REG8(UART_BASE + UART_IIR);
    if ( interrupt_id & UART_IIR_RDI )
    {
        lala = uart_getc();
        uart_putc(lala+1);
    }
 
}
 
 
void uart_print_str(char *p)
{
        while(*p != 0) {
                uart_putc(*p);
                p++;
        }
}
 
void uart_print_long(unsigned long ul)
{
  int i;
  char c;
 
 
  uart_print_str("0x");
  for(i=0; i<8; i++) {
 
  c = (char) (ul>>((7-i)*4)) & 0xf;
  if(c >= 0x0 && c<=0x9)
    c += '0';
  else
    c += 'a' - 10;
  uart_putc(c);
  }
 
}
 
void uart_print_short(unsigned long ul)
{
  int i;
  char c;
  char flag=0;
 
 
  uart_print_str("0x");
  for(i=0; i<8; i++) {
 
  c = (char) (ul>>((7-i)*4)) & 0xf;
  if(c >= 0x0 && c<=0x9)
    c += '0';
  else
    c += 'a' - 10;
  if ((c != '0') || (i==7))
    flag=1;
  if(flag)
    uart_putc(c);
  }
 
}
 
int tx_done;
int rx_done;
int rx_len;
char tx_data[1536];     //max length
char rx_data[1536];
 
void eth_init()
{
	//TXEN & RXEN = 1; PAD & CRC = 1; FULLD = 1
	REG32(ETH_BASE + ETH_MODER) = ETH_TXEN | ETH_RXEN | ETH_PAD | ETH_CRCEN | ETH_FULLD;
	//PHY Address = 0x001
	REG32(ETH_BASE + ETH_MIIADDRESS) = 0x00000001;
 
	//enable all interrupts
	REG32(ETH_BASE + ETH_INT_MASK) = ETH_RXC | ETH_TXC | ETH_BUSY | ETH_RXE | ETH_RXB | ETH_TXE | ETH_TXB;
 
	//set MAC ADDRESS
	REG32(ETH_BASE + ETH_MAC_ADDR1) = OWN_MAC_ADDRESS >> 32;	//low word = mac address high word
	REG32(ETH_BASE + ETH_MAC_ADDR0) = OWN_MAC_ADDRESS;		//mac address rest
 
	//configure TXBD0
	REG32(ETH_BASE + ETH_TXBD0H) = tx_data;		//address used for tx_data
	REG32(ETH_BASE + ETH_TXBD0L) = TX_READY;	//length = 0 | PAD & CRC = 1 | IRQ & WR = 1
 
	//configure RXBD0
	REG32(ETH_BASE + ETH_RXBD0H) = rx_data;		//address used for tx_data
	REG32(ETH_BASE + ETH_RXBD0L) = RX_READY;	//len = 0 | IRQ & WR = 1 | EMPTY = 1
 
	//set txdata
	tx_data[0] = BROADCAST_ADDRESS >> 40;
	tx_data[1] = BROADCAST_ADDRESS >> 32;
	tx_data[2] = BROADCAST_ADDRESS >> 24;
	tx_data[3] = BROADCAST_ADDRESS >> 16;
	tx_data[4] = BROADCAST_ADDRESS >> 8;
	tx_data[5] = BROADCAST_ADDRESS;
 
	tx_data[6] = OWN_MAC_ADDRESS >> 40;
	tx_data[7] = OWN_MAC_ADDRESS >> 32;
	tx_data[8] = OWN_MAC_ADDRESS >> 24;
	tx_data[9] = OWN_MAC_ADDRESS >> 16;
	tx_data[10] = OWN_MAC_ADDRESS >> 8;
	tx_data[11] = OWN_MAC_ADDRESS;
 
	//erase interrupts
	REG32(ETH_BASE + ETH_INT_SOURCE) = ETH_RXC | ETH_TXC | ETH_BUSY | ETH_RXE | ETH_RXB | ETH_TXE | ETH_TXB;
 
    tx_done = 1;
    rx_done = 0;
    rx_len = 0;
}
 
void eth_send(int length)
{
    if (!tx_done)
        return;
 
    tx_done = 0;
	tx_data[12] = length >> 8;
	tx_data[13] = length;
 
	REG32(ETH_BASE + ETH_TXBD0L) = (( 0x0000FFFF & ( length + HDR_LEN ) ) << 16) | BD_SND;
}
 
void eth_receive()
{
    int i;
    uart_print_str("Length: \n");
    uart_print_long(rx_len - HDR_LEN - CRC_LEN);
    uart_print_str("\n");
    uart_print_str("Data: \n");
    for ( i = 0; i < rx_len - HDR_LEN - CRC_LEN; i++ )
    {
        uart_print_short(rx_data[i+HDR_LEN]);
//        uart_print_str("\n");
    }
 
    rx_done = 0;
    rx_len = 0;
}
 
void eth_interrupt()
{
    unsigned long source = REG32(ETH_BASE + ETH_INT_SOURCE);
    switch (source)
    {
        case ETH_TXB:
            tx_done = 1;
            //erase interrupt
            REG32(ETH_BASE + ETH_INT_SOURCE) |= ETH_TXB;
            break;
 
        case ETH_RXB:
            rx_done = 1;
            //erase interrupt
            REG32(ETH_BASE + ETH_INT_SOURCE) |= ETH_RXB;
            //accept further data (reset RXBD to empty)
            rx_len = (REG32(ETH_BASE + ETH_RXBD0L) >> 16);
            REG32(ETH_BASE + ETH_RXBD0L) = RX_READY;	//len = 0 | IRQ & WR = 1 | EMPTY = 1
            break;
 
        default:
            break;
    }
}
 
int main()
{
    unsigned long lalala;
	uart_init();
 
	int_init();
	int_add(UART_IRQ, &uart_interrupt);
	int_add(ETH_IRQ, &eth_interrupt);
 
	/* We can't use printf because in this simple example
	   we don't link C library. */
	uart_print_str("Hello World.\n\r");
 
	eth_init();
 
	tx_data[14] = 0xFF;
	tx_data[15] = 0x2B;
	tx_data[16] = 0x40;
	tx_data[17] = 0x50;
 
	eth_send(4);
 
    while(1)
    {
        if (rx_done)
        {
            eth_receive();
        }
    }
 
	report(0xdeaddead);
	or32_exit(0);
}