Subversion Repositories minsoc

#include "../../backend/board.h"

#include "../support/support.h"

#include "eth.h"

int eth_tx_done;

int eth_rx_done;

int eth_rx_len;

unsigned char eth_tx_packet[1536];     //max length

unsigned char eth_rx_packet[1536];

unsigned char * eth_tx_data;

unsigned char * eth_rx_data;

void eth_recv_ack(void)

{

        eth_rx_done = 0;

        eth_rx_len = 0;

        //accept further data (reset RXBD to empty)

        REG32(ETH_BASE + ETH_RXBD0L) = RX_READY;        //len = 0 | IRQ & WR = 1 | EMPTY = 1    

}

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_RXB | ETH_TXB;

        //set MAC ADDRESS

        REG32(ETH_BASE + ETH_MAC_ADDR1) = (OWN_MAC_ADDRESS_5 << 8) | OWN_MAC_ADDRESS_4; //low word = mac address high word

        REG32(ETH_BASE + ETH_MAC_ADDR0) = (OWN_MAC_ADDRESS_3 << 24) | (OWN_MAC_ADDRESS_2 << 16)

                | (OWN_MAC_ADDRESS_1 << 8) | OWN_MAC_ADDRESS_0;         //mac address rest

        //configure TXBD0

        REG32(ETH_BASE + ETH_TXBD0H) = (unsigned long)eth_tx_packet;            //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) = (unsigned long)eth_rx_packet;            //address used for tx_data

        REG32(ETH_BASE + ETH_RXBD0L) = RX_READY;        //len = 0 | IRQ & WR = 1 | EMPTY = 1

        //set txdata

        eth_tx_packet[0] = BROADCAST_ADDRESS_5;

        eth_tx_packet[1] = BROADCAST_ADDRESS_4;

        eth_tx_packet[2] = BROADCAST_ADDRESS_3;

        eth_tx_packet[3] = BROADCAST_ADDRESS_2;

        eth_tx_packet[4] = BROADCAST_ADDRESS_1;

        eth_tx_packet[5] = BROADCAST_ADDRESS_0;

        eth_tx_packet[6] = OWN_MAC_ADDRESS_5;

        eth_tx_packet[7] = OWN_MAC_ADDRESS_4;

        eth_tx_packet[8] = OWN_MAC_ADDRESS_3;

        eth_tx_packet[9] = OWN_MAC_ADDRESS_2;

        eth_tx_packet[10] = OWN_MAC_ADDRESS_1;

        eth_tx_packet[11] = OWN_MAC_ADDRESS_0;

        //erase interrupts

        REG32(ETH_BASE + ETH_INT_SOURCE) = ETH_RXC | ETH_TXC | ETH_BUSY | ETH_RXE | ETH_RXB | ETH_TXE | ETH_TXB;

        eth_tx_done = 1;

        eth_rx_done = 0;

        eth_rx_len = 0;

        eth_tx_data = &eth_tx_packet[HDR_LEN];

        eth_rx_data = &eth_rx_packet[HDR_LEN];

}

int eth_send(int length)

{

        if (!eth_tx_done)       //if previous command not fully processed, bail out

                return -1;

        int i;

        eth_tx_done = 0;

        eth_tx_packet[12] = length >> 8;

        eth_tx_packet[13] = length;

        REG32(ETH_BASE + ETH_TXBD0L) = (( 0x0000FFFF & ( length + HDR_LEN ) ) << 16) | BD_SND;

        return length;

}

void eth_interrupt()

{

        unsigned long source = REG32(ETH_BASE + ETH_INT_SOURCE);

        if ( source & ETH_TXB )

        {

                eth_tx_done = 1;

                //erase interrupt

                REG32(ETH_BASE + ETH_INT_SOURCE) |= ETH_TXB;

        }

        if ( source & ETH_RXB )

        {

                eth_rx_done = 1;

                eth_rx_len = (REG32(ETH_BASE + ETH_RXBD0L) >> 16) - HDR_LEN - CRC_LEN;

                //erase interrupt

                REG32(ETH_BASE + ETH_INT_SOURCE) |= ETH_RXB;

        }

}