/* Ethernet test */
|
/* Ethernet test */
|
|
|
#include "spr_defs.h"
|
#include "spr_defs.h"
|
#include "support.h"
|
#include "support.h"
|
#include "board.h"
|
#include "board.h"
|
|
|
typedef long off_t;
|
typedef long off_t;
|
|
|
#include "../peripheral/fields.h"
|
#include "../peripheral/fields.h"
|
#include "../peripheral/ethernet.h"
|
#include "../peripheral/ethernet.h"
|
|
|
typedef volatile unsigned long *REGISTER;
|
typedef volatile unsigned long *REGISTER;
|
|
|
REGISTER
|
REGISTER
|
eth_moder = (unsigned long *)(ETH_BASE + ETH_MODER),
|
eth_moder = (unsigned long *)(ETH_BASE + ETH_MODER),
|
eth_int_source = (unsigned long *)(ETH_BASE + ETH_INT_SOURCE),
|
eth_int_source = (unsigned long *)(ETH_BASE + ETH_INT_SOURCE),
|
eth_int_mask = (unsigned long *)(ETH_BASE + ETH_INT_MASK),
|
eth_int_mask = (unsigned long *)(ETH_BASE + ETH_INT_MASK),
|
eth_ipgt = (unsigned long *)(ETH_BASE + ETH_IPGT),
|
eth_ipgt = (unsigned long *)(ETH_BASE + ETH_IPGT),
|
eth_ipgr1 = (unsigned long *)(ETH_BASE + ETH_IPGR1),
|
eth_ipgr1 = (unsigned long *)(ETH_BASE + ETH_IPGR1),
|
eth_ipgr2 = (unsigned long *)(ETH_BASE + ETH_IPGR2),
|
eth_ipgr2 = (unsigned long *)(ETH_BASE + ETH_IPGR2),
|
eth_packetlen = (unsigned long *)(ETH_BASE + ETH_PACKETLEN),
|
eth_packetlen = (unsigned long *)(ETH_BASE + ETH_PACKETLEN),
|
eth_collconf = (unsigned long *)(ETH_BASE + ETH_COLLCONF),
|
eth_collconf = (unsigned long *)(ETH_BASE + ETH_COLLCONF),
|
eth_tx_bd_num = (unsigned long *)(ETH_BASE + ETH_TX_BD_NUM),
|
eth_tx_bd_num = (unsigned long *)(ETH_BASE + ETH_TX_BD_NUM),
|
eth_controlmoder = (unsigned long *)(ETH_BASE + ETH_CTRLMODER),
|
eth_controlmoder = (unsigned long *)(ETH_BASE + ETH_CTRLMODER),
|
eth_miimoder = (unsigned long *)(ETH_BASE + ETH_MIIMODER),
|
eth_miimoder = (unsigned long *)(ETH_BASE + ETH_MIIMODER),
|
eth_miicommand = (unsigned long *)(ETH_BASE + ETH_MIICOMMAND),
|
eth_miicommand = (unsigned long *)(ETH_BASE + ETH_MIICOMMAND),
|
eth_miiaddress = (unsigned long *)(ETH_BASE + ETH_MIIADDRESS),
|
eth_miiaddress = (unsigned long *)(ETH_BASE + ETH_MIIADDRESS),
|
eth_miitx_data = (unsigned long *)(ETH_BASE + ETH_MIITX_DATA),
|
eth_miitx_data = (unsigned long *)(ETH_BASE + ETH_MIITX_DATA),
|
eth_miirx_data = (unsigned long *)(ETH_BASE + ETH_MIIRX_DATA),
|
eth_miirx_data = (unsigned long *)(ETH_BASE + ETH_MIIRX_DATA),
|
eth_miistatus = (unsigned long *)(ETH_BASE + ETH_MIISTATUS),
|
eth_miistatus = (unsigned long *)(ETH_BASE + ETH_MIISTATUS),
|
eth_mac_addr0 = (unsigned long *)(ETH_BASE + ETH_MAC_ADDR0),
|
eth_mac_addr0 = (unsigned long *)(ETH_BASE + ETH_MAC_ADDR0),
|
eth_mac_addr1 = (unsigned long *)(ETH_BASE + ETH_MAC_ADDR1),
|
eth_mac_addr1 = (unsigned long *)(ETH_BASE + ETH_MAC_ADDR1),
|
eth_bd_base = (unsigned long *)(ETH_BASE + ETH_BD_BASE);
|
eth_bd_base = (unsigned long *)(ETH_BASE + ETH_BD_BASE);
|
|
|
volatile unsigned int_happend;
|
volatile unsigned int_happend;
|
unsigned char r_packet[2000];
|
unsigned char r_packet[2000];
|
unsigned char s_packet[1003];
|
unsigned char s_packet[1003];
|
unsigned tx_bindex;
|
unsigned tx_bindex;
|
unsigned rx_bindex;
|
unsigned rx_bindex;
|
|
|
void interrupt_handler()
|
void interrupt_handler()
|
{
|
{
|
unsigned i,len;
|
unsigned i,len;
|
|
|
printf ("Int\n");
|
printf ("Int\n");
|
switch (*eth_int_source & 0x7f) {
|
switch (*eth_int_source & 0x7f) {
|
case 0x2 :
|
case 0x2 :
|
printf ("Transmit Error.\n");
|
printf ("Transmit Error.\n");
|
*eth_int_source = 0x2;
|
*eth_int_source = 0x2;
|
break;
|
break;
|
case 0x8 :
|
case 0x8 :
|
printf ("Receive Error\n");
|
printf ("Receive Error\n");
|
*eth_int_source = 0x8;
|
*eth_int_source = 0x8;
|
break;
|
break;
|
case 0x4 :
|
case 0x4 :
|
printf ("Receive Frame\n");
|
printf ("Receive Frame\n");
|
*eth_int_source = 0x4;
|
*eth_int_source = 0x4;
|
|
|
CLEAR_FLAG(*eth_moder, ETH_MODER, RXEN);
|
CLEAR_FLAG(*eth_moder, ETH_MODER, RXEN);
|
|
|
len = GET_FIELD(eth_bd_base[(*eth_tx_bd_num << 1) + 2], ETH_RX_BD, LENGTH);
|
len = GET_FIELD(eth_bd_base[(*eth_tx_bd_num << 1) + 2], ETH_RX_BD, LENGTH);
|
for (i=0; i<len; i++)
|
for (i=0; i<len; i++)
|
if (r_packet[i] != (unsigned char)i)
|
if (r_packet[i] != (unsigned char)i)
|
{
|
{
|
printf("Failed at byte %d. expect %d, received %d\n", i, i, r_packet[i]);
|
printf("Failed at byte %d. expect %d, received %d\n", i, i, r_packet[i]);
|
exit(1);
|
exit(1);
|
}
|
}
|
break;
|
break;
|
case 0x10:
|
case 0x10:
|
printf ("Busy\n");
|
printf ("Busy\n");
|
*eth_int_source = 0x10;
|
*eth_int_source = 0x10;
|
break;
|
break;
|
case 0x1 :
|
case 0x1 :
|
printf ("Transmit Frame.\n");
|
printf ("Transmit Frame.\n");
|
*eth_int_source = 0x1;
|
*eth_int_source = 0x1;
|
CLEAR_FLAG(*eth_moder, ETH_MODER, TXEN);
|
CLEAR_FLAG(*eth_moder, ETH_MODER, TXEN);
|
|
|
break;
|
break;
|
default:
|
default:
|
printf ("Invalid int @ %0x\n", (unsigned int)*eth_int_source & 0x7f);
|
printf ("Invalid int @ %0x\n", (unsigned int)*eth_int_source & 0x7f);
|
*eth_int_source = 0x7f;
|
*eth_int_source = 0x7f;
|
exit (1);
|
exit (1);
|
}
|
}
|
|
|
mtspr(SPR_PICSR, 0);
|
mtspr(SPR_PICSR, 0);
|
int_happend = 1;
|
int_happend = 1;
|
}
|
}
|
|
|
static void set_mac( void )
|
static void set_mac( void )
|
{
|
{
|
*eth_mac_addr0 = 0x04030201LU;
|
*eth_mac_addr0 = 0x04030201LU;
|
*eth_mac_addr1 = 0x00000605LU;
|
*eth_mac_addr1 = 0x00000605LU;
|
}
|
}
|
|
|
static void transmit_one_packet( void )
|
static void transmit_one_packet( void )
|
{
|
{
|
unsigned i;
|
unsigned i;
|
|
|
/* Initialize packet */
|
/* Initialize packet */
|
for ( i = 0; i < sizeof(s_packet); ++ i )
|
for ( i = 0; i < sizeof(s_packet); ++ i )
|
s_packet[i] = (unsigned char)i;
|
s_packet[i] = (unsigned char)i;
|
|
|
/* Set Ethernet BD */
|
/* Set Ethernet BD */
|
SET_FIELD(eth_bd_base[tx_bindex], ETH_TX_BD, LENGTH, sizeof(s_packet));
|
SET_FIELD(eth_bd_base[tx_bindex], ETH_TX_BD, LENGTH, sizeof(s_packet));
|
eth_bd_base[tx_bindex + 1] = (unsigned long)s_packet;
|
eth_bd_base[tx_bindex + 1] = (unsigned long)s_packet;
|
|
|
/* Start Ethernet */
|
/* Start Ethernet */
|
SET_FLAG(eth_bd_base[tx_bindex], ETH_TX_BD, READY);
|
SET_FLAG(eth_bd_base[tx_bindex], ETH_TX_BD, READY);
|
SET_FLAG(*eth_moder, ETH_MODER, TXEN);
|
SET_FLAG(*eth_moder, ETH_MODER, TXEN);
|
|
|
/* Now wait till sent */
|
/* Now wait till sent */
|
while ( TEST_FLAG( eth_bd_base[tx_bindex], ETH_TX_BD, READY ) );
|
while ( TEST_FLAG( eth_bd_base[tx_bindex], ETH_TX_BD, READY ) );
|
CLEAR_FLAG(*eth_moder, ETH_MODER, TXEN);
|
CLEAR_FLAG(*eth_moder, ETH_MODER, TXEN);
|
*eth_int_source = 0x7f;
|
*eth_int_source = 0x7f;
|
}
|
}
|
|
|
static void transmit_one_packet_int( void )
|
static void transmit_one_packet_int( void )
|
{
|
{
|
unsigned i;
|
unsigned i;
|
|
|
int_happend = 0;
|
int_happend = 0;
|
/* Initialize packet */
|
/* Initialize packet */
|
printf("Init\n");
|
printf("Init\n");
|
for ( i = 0; i < sizeof(s_packet); ++ i )
|
for ( i = 0; i < sizeof(s_packet); ++ i )
|
s_packet[i] = (unsigned char)i;
|
s_packet[i] = (unsigned char)i;
|
|
|
/* Set Ethernet BD */
|
/* Set Ethernet BD */
|
printf("Set BD\n");
|
printf("Set BD\n");
|
SET_FIELD(eth_bd_base[tx_bindex], ETH_TX_BD, LENGTH, sizeof(s_packet));
|
SET_FIELD(eth_bd_base[tx_bindex], ETH_TX_BD, LENGTH, sizeof(s_packet));
|
eth_bd_base[tx_bindex + 1] = (unsigned long)s_packet;
|
eth_bd_base[tx_bindex + 1] = (unsigned long)s_packet;
|
|
|
/* Start Ethernet */
|
/* Start Ethernet */
|
printf("Set Flags\n");
|
printf("Set Flags\n");
|
SET_FLAG(eth_bd_base[tx_bindex], ETH_TX_BD, IRQ);
|
SET_FLAG(eth_bd_base[tx_bindex], ETH_TX_BD, IRQ);
|
SET_FLAG(eth_bd_base[tx_bindex], ETH_TX_BD, READY);
|
SET_FLAG(eth_bd_base[tx_bindex], ETH_TX_BD, READY);
|
SET_FLAG(*eth_moder, ETH_MODER, TXEN);
|
SET_FLAG(*eth_moder, ETH_MODER, TXEN);
|
}
|
}
|
|
|
|
|
static void receive_one_packet(void)
|
static void receive_one_packet(void)
|
{
|
{
|
unsigned int i;
|
unsigned int i;
|
unsigned int len;
|
unsigned int len;
|
|
|
eth_bd_base[rx_bindex + 1] = (unsigned long)r_packet;
|
eth_bd_base[rx_bindex + 1] = (unsigned long)r_packet;
|
|
|
SET_FLAG(eth_bd_base[rx_bindex], ETH_RX_BD, READY);
|
SET_FLAG(eth_bd_base[rx_bindex], ETH_RX_BD, READY);
|
SET_FLAG(*eth_moder, ETH_MODER, RXEN);
|
SET_FLAG(*eth_moder, ETH_MODER, RXEN);
|
|
|
while ( TEST_FLAG( eth_bd_base[rx_bindex], ETH_RX_BD, READY ) );
|
while ( TEST_FLAG( eth_bd_base[rx_bindex], ETH_RX_BD, READY ) );
|
CLEAR_FLAG(*eth_moder, ETH_MODER, RXEN);
|
CLEAR_FLAG(*eth_moder, ETH_MODER, RXEN);
|
*eth_int_source = 0x7f;
|
*eth_int_source = 0x7f;
|
|
|
len = GET_FIELD(eth_bd_base[rx_bindex], ETH_RX_BD, LENGTH);
|
len = GET_FIELD(eth_bd_base[rx_bindex], ETH_RX_BD, LENGTH);
|
for (i=0; i<len; i++)
|
for (i=0; i<len; i++)
|
if (r_packet[i] != (unsigned char)i)
|
if (r_packet[i] != (unsigned char)i)
|
{
|
{
|
printf("Failed at byte %d. expect %d, received %d\n", i, i, r_packet[i]);
|
printf("Failed at byte %d. expect %d, received %d\n", i, i, r_packet[i]);
|
exit(1);
|
exit(1);
|
}
|
}
|
}
|
}
|
|
|
static void receive_one_packet_int(void)
|
static void receive_one_packet_int(void)
|
{
|
{
|
int_happend = 0;
|
int_happend = 0;
|
printf("Set BD\n");
|
printf("Set BD\n");
|
eth_bd_base[rx_bindex + 1] = (unsigned long)r_packet;
|
eth_bd_base[rx_bindex + 1] = (unsigned long)r_packet;
|
|
|
printf("SetFlags\n");
|
printf("SetFlags\n");
|
SET_FLAG(eth_bd_base[rx_bindex], ETH_RX_BD, IRQ);
|
SET_FLAG(eth_bd_base[rx_bindex], ETH_RX_BD, IRQ);
|
SET_FLAG(eth_bd_base[rx_bindex], ETH_RX_BD, READY);
|
SET_FLAG(eth_bd_base[rx_bindex], ETH_RX_BD, READY);
|
SET_FLAG(*eth_moder, ETH_MODER, RXEN);
|
SET_FLAG(*eth_moder, ETH_MODER, RXEN);
|
}
|
}
|
|
|
int main()
|
int main()
|
{
|
{
|
printf( "Starting Ethernet test\n" );
|
printf( "Starting Ethernet test\n" );
|
|
|
tx_bindex = 0;
|
tx_bindex = 0;
|
rx_bindex = *eth_tx_bd_num << 1;
|
rx_bindex = *eth_tx_bd_num << 1;
|
|
|
set_mac();
|
set_mac();
|
|
|
/*-------------------*/
|
/*-------------------*/
|
/* non iterrupt test */
|
/* non iterrupt test */
|
transmit_one_packet();
|
transmit_one_packet();
|
tx_bindex += 2;
|
tx_bindex += 2;
|
receive_one_packet();
|
receive_one_packet();
|
rx_bindex += 2;
|
rx_bindex += 2;
|
transmit_one_packet();
|
transmit_one_packet();
|
tx_bindex += 2;
|
tx_bindex += 2;
|
receive_one_packet();
|
receive_one_packet();
|
rx_bindex += 2;
|
rx_bindex += 2;
|
|
|
|
|
/*-------------------*/
|
/*-------------------*/
|
/* interrupt test */
|
/* interrupt test */
|
excpt_int = (unsigned long)interrupt_handler;
|
excpt_int = (unsigned long)interrupt_handler;
|
/* Enable interrup ts */
|
/* Enable interrup ts */
|
printf("enable ints\n");
|
printf("enable ints\n");
|
mtspr (SPR_SR, mfspr(SPR_SR) | SPR_SR_IEE);
|
mtspr (SPR_SR, mfspr(SPR_SR) | SPR_SR_IEE);
|
mtspr (SPR_PICMR, mfspr(SPR_PICMR) | (0x00000001L << ETH_IRQ));
|
mtspr (SPR_PICMR, mfspr(SPR_PICMR) | (0x00000001L << ETH_IRQ));
|
|
|
printf("set mask flags TX\n");
|
printf("set mask flags TX\n");
|
SET_FLAG(*eth_int_mask, ETH_INT_MASK, TXB_M);
|
SET_FLAG(*eth_int_mask, ETH_INT_MASK, TXB_M);
|
transmit_one_packet_int();
|
transmit_one_packet_int();
|
tx_bindex += 2;
|
tx_bindex += 2;
|
printf("waiting for int\n");
|
printf("waiting for int\n");
|
while (!int_happend);
|
while (!int_happend);
|
CLEAR_FLAG(*eth_int_mask, ETH_INT_MASK, TXB_M);
|
CLEAR_FLAG(*eth_int_mask, ETH_INT_MASK, TXB_M);
|
|
|
printf("seting mask flag RX\n");
|
printf("seting mask flag RX\n");
|
SET_FLAG(*eth_int_mask, ETH_INT_MASK, RXB_M);
|
SET_FLAG(*eth_int_mask, ETH_INT_MASK, RXB_M);
|
receive_one_packet_int();
|
receive_one_packet_int();
|
rx_bindex += 2;
|
rx_bindex += 2;
|
printf("waiting for int\n");
|
printf("waiting for int\n");
|
while (!int_happend);
|
while (!int_happend);
|
CLEAR_FLAG(*eth_int_mask, ETH_INT_MASK, RXB_M);
|
CLEAR_FLAG(*eth_int_mask, ETH_INT_MASK, RXB_M);
|
|
|
|
|
printf( "Ending Ethernet test\n" );
|
printf( "Ending Ethernet test\n" );
|
|
|
report (0xdeaddead);
|
report (0xdeaddead);
|
exit(0);
|
exit(0);
|
}
|
}
|
|
|
|
|
|
|