Subversion Repositories openrisc

//////////////////////////////////////////////////////////////////////

////                                                              ////

////  Interrupt-driven Ethernet MAC transmit test code            ////

////                                                              ////

////  Description                                                 ////

////  Send packets while receiving packets                        ////

////                                                              ////

////  Test data comes from pre-calculated array of random values, ////

////  MAC TX buffer pointers are set to addresses in this array,  ////

////  saving copying the data around before transfers.            ////

////                                                              ////

////  Author(s):                                                  ////

////      - jb, jb@orsoc.se, with parts taken from Linux kernel   ////

////        open_eth driver.                                      ////

////                                                              ////

////                                                              ////

//////////////////////////////////////////////////////////////////////

////                                                              ////

//// Copyright (C) 2009 Authors and OPENCORES.ORG                 ////

////                                                              ////

//// This source file may be used and distributed without         ////

//// restriction provided that this copyright statement is not    ////

//// removed from the file and that any derivative work contains  ////

//// the original copyright notice and the associated disclaimer. ////

////                                                              ////

//// This source file is free software; you can redistribute it   ////

//// and/or modify it under the terms of the GNU Lesser General   ////

//// Public License as published by the Free Software Foundation; ////

//// either version 2.1 of the License, or (at your option) any   ////

//// later version.                                               ////

////                                                              ////

//// This source 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 GNU Lesser General Public License for more ////

//// details.                                                     ////

////                                                              ////

//// You should have received a copy of the GNU Lesser General    ////

//// Public License along with this source; if not, download it   ////

//// from http://www.opencores.org/lgpl.shtml                     ////

////                                                              ////

//////////////////////////////////////////////////////////////////////

#include "or32-utils.h"

#include "spr-defs.h"

#include "board.h"

#include "int.h"

//#include "uart.h" // comment this out, UART uses simulation putc()

#include "open-eth.h"

#include "printf.h"

#include "eth-phy-mii.h"

volatile unsigned tx_done;

volatile unsigned rx_done;

static int next_tx_buf_num;

/* Functions in this file */

void ethmac_setup(void);

/* Interrupt functions */

void oeth_interrupt(void);

static void oeth_rx(void);

static void oeth_tx(void);

/* Defining RTLSIM turns off use of real printf'ing to save time in simulation */

#define RTLSIM

#ifdef RTLSIM

#define printk

#else

#define printk printf

#endif

/* Let the ethernet packets use a space beginning here for buffering */

#define ETH_BUFF_BASE 0x01000000

#define RXBUFF_PREALLOC 1

#define TXBUFF_PREALLOC 1

//#undef RXBUFF_PREALLOC

//#undef TXBUFF_PREALLOC

/* The transmitter timeout

*/

#define TX_TIMEOUT      (2*HZ)

/* Buffer number (must be 2^n)

*/

#define OETH_RXBD_NUM           16

#define OETH_TXBD_NUM           16

#define OETH_RXBD_NUM_MASK      (OETH_RXBD_NUM-1)

#define OETH_TXBD_NUM_MASK      (OETH_TXBD_NUM-1)

/* Buffer size

*/

#define OETH_RX_BUFF_SIZE       0x600-4

#define OETH_TX_BUFF_SIZE       0x600-4

/* OR32 Page size def */

#define PAGE_SHIFT              13

#define PAGE_SIZE               (1UL << PAGE_SHIFT)

/* How many buffers per page

*/

#define OETH_RX_BUFF_PPGAE      (PAGE_SIZE/OETH_RX_BUFF_SIZE)

#define OETH_TX_BUFF_PPGAE      (PAGE_SIZE/OETH_TX_BUFF_SIZE)

/* How many pages is needed for buffers

*/

#define OETH_RX_BUFF_PAGE_NUM   (OETH_RXBD_NUM/OETH_RX_BUFF_PPGAE)

#define OETH_TX_BUFF_PAGE_NUM   (OETH_TXBD_NUM/OETH_TX_BUFF_PPGAE)

/* Buffer size  (if not XXBUF_PREALLOC

*/

#define MAX_FRAME_SIZE          1518

/* The buffer descriptors track the ring buffers.

*/

struct oeth_private {

  //struct      sk_buff* rx_skbuff[OETH_RXBD_NUM];

  //struct      sk_buff* tx_skbuff[OETH_TXBD_NUM];

  unsigned short        tx_next; /* Next buffer to be sent */

  unsigned short        tx_last; /* Next buffer to be checked if packet sent */

  unsigned short        tx_full; /* Buffer ring fuul indicator */

  unsigned short        rx_cur;  /* Next buffer to be checked if packet

                                    received */

  oeth_regs     *regs;                  /* Address of controller registers. */

  oeth_bd               *rx_bd_base;            /* Address of Rx BDs. */

  oeth_bd               *tx_bd_base;            /* Address of Tx BDs. */

  //    struct net_device_stats stats;

};

#define PHYNUM 7

// Data array of data to transmit, tx_data_array[]

#include "eth-rxtx-data.h"

int tx_data_pointer;

/* Scan the MIIM bus for PHYs */

void scan_ethphys(void)

{

  unsigned int phynum,regnum, i;

  volatile oeth_regs *regs;

  regs = (oeth_regs *)(OETH_REG_BASE);

  regs->miitx_data = 0;

  for(phynum=0;phynum<32;phynum++)

    {

      for (regnum=0;regnum<8;regnum++)

        {

          printk("scan_ethphys: phy %d r%d ",phynum, regnum);

          /* Now actually perform the read on the MIIM bus*/

          regs->miiaddress = (regnum << 8) | phynum;

          regs->miicommand = OETH_MIICOMMAND_RSTAT;

           /* Wait for command to be registered*/

          while(!(regs->miistatus & OETH_MIISTATUS_BUSY));

          regs->miicommand = 0;

          while(regs->miistatus & OETH_MIISTATUS_BUSY);

          printk("%x\n",regs->miirx_data);

        }

    }

}

void ethmac_scanstatus(void)

{

  volatile oeth_regs *regs;

  regs = (oeth_regs *)(OETH_REG_BASE);

  printk("Oeth: regs->miistatus %x regs->miirx_data %x\n",regs->miistatus, regs->miirx_data);

  regs->miiaddress = 0;

  regs->miitx_data = 0;

  regs->miicommand = OETH_MIICOMMAND_SCANSTAT;

  printk("Oeth: regs->miiaddress %x regs->miicommand %x\n",regs->miiaddress, regs->miicommand);

  //regs->miicommand = 0; 

  volatile int i; for(i=0;i<1000;i++);

  while(regs->miistatus & OETH_MIISTATUS_BUSY) ;

  //spin_cursor(); 

  //printk("\r"); 

  //or32_exit(0);

}

void

eth_mii_write(char phynum, short regnum, short data)

{

  static volatile oeth_regs *regs = (oeth_regs *)(OETH_REG_BASE);

  regs->miiaddress = (regnum << 8) | phynum;

  regs->miitx_data = data;

  regs->miicommand = OETH_MIICOMMAND_WCTRLDATA;

  regs->miicommand = 0;

  while(regs->miistatus & OETH_MIISTATUS_BUSY);

}

short

eth_mii_read(char phynum, short regnum)

{

  static volatile oeth_regs *regs = (oeth_regs *)(OETH_REG_BASE);

  regs->miiaddress = (regnum << 8) | phynum;

  regs->miicommand = OETH_MIICOMMAND_RSTAT;

  regs->miicommand = 0;

  while(regs->miistatus & OETH_MIISTATUS_BUSY);

  return regs->miirx_data;

}

// Wait here until all packets have been transmitted

void wait_until_all_tx_clear(void)

{

  int i;

  volatile oeth_bd *tx_bd;

  tx_bd = (volatile oeth_bd *)OETH_BD_BASE; /* Search from beginning*/

  int some_tx_waiting = 1;

  while (some_tx_waiting)

    {

      some_tx_waiting = 0;

      /* Go through the TX buffs, search for unused one */

      for(i = 0; i < OETH_TXBD_NUM; i++) {

        if((tx_bd[i].len_status & OETH_TX_BD_READY)) // Looking for buffer ready for transmit

          some_tx_waiting = 1;

      }

    }

}

void

ethphy_set_10mbit(int phynum)

{

  wait_until_all_tx_clear();

  // Hardset PHY to just use 10Mbit mode

  short cr = eth_mii_read(phynum, MII_BMCR);

  cr &= ~BMCR_ANENABLE; // Clear auto negotiate bit

  cr &= ~BMCR_SPEED100; // Clear fast eth. bit

  eth_mii_write(phynum, MII_BMCR, cr);

}

void

ethphy_set_100mbit(int phynum)

{

  wait_until_all_tx_clear();

  // Hardset PHY to just use 100Mbit mode

  short cr = eth_mii_read(phynum, MII_BMCR);

  cr |= BMCR_ANENABLE; // Clear auto negotiate bit

  cr |= BMCR_SPEED100; // Clear fast eth. bit

  eth_mii_write(phynum, MII_BMCR, cr);

}

void ethmac_setup(void)

{

  // from arch/or32/drivers/open_eth.c

  volatile oeth_regs *regs;

  regs = (oeth_regs *)(OETH_REG_BASE);

  /* Reset MII mode module */

  regs->miimoder = OETH_MIIMODER_RST; /* MII Reset ON */

  regs->miimoder &= ~OETH_MIIMODER_RST; /* MII Reset OFF */

  regs->miimoder = 0x64; /* Clock divider for MII Management interface */

  /* Reset the controller.

  */

  regs->moder = OETH_MODER_RST; /* Reset ON */

  regs->moder &= ~OETH_MODER_RST;       /* Reset OFF */

  /* Setting TXBD base to OETH_TXBD_NUM.

  */

  regs->tx_bd_num = OETH_TXBD_NUM;

  /* Set min/max packet length

  */

  regs->packet_len = 0x00400600;

  /* Set IPGT register to recomended value

  */

  regs->ipgt = 0x12;

  /* Set IPGR1 register to recomended value

  */

  regs->ipgr1 = 0x0000000c;

  /* Set IPGR2 register to recomended value

  */

  regs->ipgr2 = 0x00000012;

  /* Set COLLCONF register to recomended value

  */

  regs->collconf = 0x000f003f;

  /* Set control module mode

  */

#if 0

  regs->ctrlmoder = OETH_CTRLMODER_TXFLOW | OETH_CTRLMODER_RXFLOW;

#else

  regs->ctrlmoder = 0;

#endif

  /* Clear MIIM registers */

  regs->miitx_data = 0;

  regs->miiaddress = 0;

  regs->miicommand = 0;

  regs->mac_addr1 = ETH_MACADDR0 << 8 | ETH_MACADDR1;

  regs->mac_addr0 = ETH_MACADDR2 << 24 | ETH_MACADDR3 << 16 | ETH_MACADDR4 << 8 | ETH_MACADDR5;

  /* Clear all pending interrupts

  */

  regs->int_src = 0xffffffff;

  /* Promisc, IFG, CRCEn

  */

  regs->moder |= OETH_MODER_PRO | OETH_MODER_PAD | OETH_MODER_IFG | OETH_MODER_CRCEN | OETH_MODER_FULLD;

  /* Enable interrupt sources.

  */

  regs->int_mask = OETH_INT_MASK_TXB    |

    OETH_INT_MASK_TXE   |

    OETH_INT_MASK_RXF   |

    OETH_INT_MASK_RXE   |

    OETH_INT_MASK_BUSY  |

    OETH_INT_MASK_TXC   |

    OETH_INT_MASK_RXC;

  // Buffer setup stuff

  volatile oeth_bd *tx_bd, *rx_bd;

  int i,j,k;

  /* Initialize TXBD pointer

  */

  tx_bd = (volatile oeth_bd *)OETH_BD_BASE;

  /* Initialize RXBD pointer

  */

  rx_bd = ((volatile oeth_bd *)OETH_BD_BASE) + OETH_TXBD_NUM;

  /* Preallocated ethernet buffer setup */

  unsigned long mem_addr = ETH_BUFF_BASE; /* Defined at top */

  // Setup TX Buffers

  for(i = 0; i < OETH_TXBD_NUM; i++) {

    //tx_bd[i].len_status = OETH_TX_BD_PAD | OETH_TX_BD_CRC | OETH_RX_BD_IRQ;

    tx_bd[i].len_status = OETH_TX_BD_PAD | OETH_TX_BD_CRC;

    tx_bd[i].addr = mem_addr;

    mem_addr += OETH_TX_BUFF_SIZE;

  }

  tx_bd[OETH_TXBD_NUM - 1].len_status |= OETH_TX_BD_WRAP;

  // Setup RX buffers

  for(i = 0; i < OETH_RXBD_NUM; i++) {

    rx_bd[i].len_status = OETH_RX_BD_EMPTY | OETH_RX_BD_IRQ; // Init. with IRQ

    rx_bd[i].addr = mem_addr;

    mem_addr += OETH_RX_BUFF_SIZE;

  }

  rx_bd[OETH_RXBD_NUM - 1].len_status |= OETH_RX_BD_WRAP; // Last buffer wraps

  /* Enable JUST the transmiter

  */

  regs->moder &= ~(OETH_MODER_RXEN | OETH_MODER_TXEN);

  regs->moder |= /*OETH_MODER_RXEN |*/ OETH_MODER_TXEN;

  next_tx_buf_num = 0; // init tx buffer pointer

  return;

}

// Enable RX in ethernet MAC

void

oeth_enable_rx(void)

{

  volatile oeth_regs *regs;

  regs = (oeth_regs *)(OETH_REG_BASE);

  regs->moder |= OETH_MODER_RXEN;

}

// Disable RX in ethernet MAC

void

oeth_disable_rx(void)

{

  volatile oeth_regs *regs;

  regs = (oeth_regs *)(OETH_REG_BASE);

  regs->moder &= ~(OETH_MODER_RXEN);

}

/* Setup buffer descriptors with data */

/* length is in BYTES */

void tx_packet(void* data, int length)

{

  volatile oeth_regs *regs;

  regs = (oeth_regs *)(OETH_REG_BASE);

  volatile oeth_bd *tx_bd;

  volatile int i;

  tx_bd = (volatile oeth_bd *)OETH_BD_BASE;

  tx_bd = (struct oeth_bd*) &tx_bd[next_tx_buf_num];

  // If it's in use - wait

  while ((tx_bd->len_status & OETH_TX_BD_IRQ));

  /* Clear all of the status flags.

  */

  tx_bd->len_status &= ~OETH_TX_BD_STATS;

  /* If the frame is short, tell CPM to pad it.

  */

#define ETH_ZLEN        60   /* Min. octets in frame sans FCS */

  if (length <= ETH_ZLEN)

    tx_bd->len_status |= OETH_TX_BD_PAD;

  else

    tx_bd->len_status &= ~OETH_TX_BD_PAD;

#ifdef _ETH_RXTX_DATA_H_

  // Set the address pointer to the place

  // in memory where the data is and transmit from there

  tx_bd->addr = (char*) &tx_data_array[tx_data_pointer&~(0x3)];

  tx_data_pointer += length + 1;

  if (tx_data_pointer > (255*1024))

    tx_data_pointer = 0;

#else

  if (data){

    //Copy the data into the transmit buffer, byte at a time 

    char* data_p = (char*) data;

    char* data_b = (char*) tx_bd->addr;

    for(i=0;i<length;i++)

      {

        data_b[i] = data_p[i];

      }

  }

#endif

  /* Set the length of the packet's data in the buffer descriptor */

  tx_bd->len_status = (tx_bd->len_status & 0x0000ffff) |

    ((length&0xffff) << 16);

  /* Send it on its way.  Tell controller its ready, interrupt when sent

  * and to put the CRC on the end.

  */

  tx_bd->len_status |= (OETH_TX_BD_READY  | OETH_TX_BD_CRC | OETH_TX_BD_IRQ);

  next_tx_buf_num = (next_tx_buf_num + 1) & OETH_TXBD_NUM_MASK;

  return;

}

/* The interrupt handler.

*/

void

oeth_interrupt(void)

{

  volatile oeth_regs *regs;

  regs = (oeth_regs *)(OETH_REG_BASE);

  uint  int_events;

  int serviced;

  serviced = 0;

  /* Get the interrupt events that caused us to be here.

  */

  int_events = regs->int_src;

  regs->int_src = int_events;

  /* Handle receive event in its own function.

  */

  if (int_events & (OETH_INT_RXF | OETH_INT_RXE)) {

    serviced |= 0x1;

    oeth_rx();

  }

  /* Handle transmit event in its own function.

  */

  if (int_events & (OETH_INT_TXB | OETH_INT_TXE)) {

    serviced |= 0x2;

    oeth_tx();

    serviced |= 0x2;

  }

  /* Check for receive busy, i.e. packets coming but no place to

  * put them.

  */

  if (int_events & OETH_INT_BUSY) {

    serviced |= 0x4;

    if (!(int_events & (OETH_INT_RXF | OETH_INT_RXE)))

      oeth_rx();

  }

  return;

}

static void

oeth_rx(void)

{

  volatile oeth_regs *regs;

  regs = (oeth_regs *)(OETH_REG_BASE);

  volatile oeth_bd *rx_bdp;

  int   pkt_len, i;

  int   bad = 0;

  rx_bdp = ((oeth_bd *)OETH_BD_BASE) + OETH_TXBD_NUM;

  printk("r");

  /* Find RX buffers marked as having received data */

  for(i = 0; i < OETH_RXBD_NUM; i++)

    {

      bad=0;

      if(!(rx_bdp[i].len_status & OETH_RX_BD_EMPTY)){ /* Looking for NOT empty buffers desc. */

        /* Check status for errors.

        */

        if (rx_bdp[i].len_status & (OETH_RX_BD_TOOLONG | OETH_RX_BD_SHORT)) {

          bad = 1;

          report(0xbaad0001);

        }

        if (rx_bdp[i].len_status & OETH_RX_BD_DRIBBLE) {

          bad = 1;

          report(0xbaad0002);

        }

        if (rx_bdp[i].len_status & OETH_RX_BD_CRCERR) {

          bad = 1;

          report(0xbaad0003);

        }

        if (rx_bdp[i].len_status & OETH_RX_BD_OVERRUN) {

          bad = 1;

          report(0xbaad0004);

        }

        if (rx_bdp[i].len_status & OETH_RX_BD_MISS) {

          report(0xbaad0005);

        }

        if (rx_bdp[i].len_status & OETH_RX_BD_LATECOL) {

          bad = 1;

          report(0xbaad0006);

        }

        if (bad) {

          rx_bdp[i].len_status &= ~OETH_RX_BD_STATS;

          rx_bdp[i].len_status |= OETH_RX_BD_EMPTY;

          exit(0xbaaaaaad);

          continue;

        }

        else {

          /* Process the incoming frame.

          */

          pkt_len = rx_bdp[i].len_status >> 16;

          /* finish up */

          rx_bdp[i].len_status &= ~OETH_RX_BD_STATS; /* Clear stats */

          rx_bdp[i].len_status |= OETH_RX_BD_EMPTY; /* Mark RX BD as empty */

          rx_done++;

        }

      }

    }

}

static void

oeth_tx(void)

{

  volatile oeth_bd *tx_bd;

  int i;

  tx_bd = (volatile oeth_bd *)OETH_BD_BASE; /* Search from beginning*/

  /* Go through the TX buffs, search for one that was just sent */

  for(i = 0; i < OETH_TXBD_NUM; i++)

    {

      /* Looking for buffer NOT ready for transmit. and IRQ enabled */

      if( (!(tx_bd[i].len_status & (OETH_TX_BD_READY))) && (tx_bd[i].len_status & (OETH_TX_BD_IRQ)) )

        {

          /* Single threaded so no chance we have detected a buffer that has had its IRQ bit set but not its BD_READ flag. Maybe this won't work in linux */

          tx_bd[i].len_status &= ~OETH_TX_BD_IRQ;

          /* Probably good to check for TX errors here */

          /* set our test variable */

          tx_done++;

          printk("T%d",i);

        }

    }

  return;

}

// A function and defines to fill and transmit a packet

#define MAX_TX_BUFFER 1532

static char tx_buffer[MAX_TX_BUFFER];

static unsigned long tx_data = 0x26fab2f2;

static inline char gen_next_tx_byte(void)

{

  // Bit of LFSR action

  tx_data = ((~(((((tx_data&(1<<25))>>25)^((tx_data&(1<<13))>>13))^((tx_data&(1<<2))>>2)))&0x01) | (tx_data<<1));

  //tx_data =(!((tx_data>>26) ^ (tx_data>>14) ^ (tx_data>>5) ^ (tx_data>>3)) & 0x1) | (tx_data<<1);

return (char) tx_data & 0xff;

}

void

fill_and_tx_packet(int size)

{

  int i;

  char tx_byte;

  volatile oeth_regs *regs;

  regs = (oeth_regs *)(OETH_REG_BASE);

  volatile oeth_bd *tx_bd;

  //tx_bd = (volatile oeth_bd *)OETH_BD_BASE;

  tx_bd = (volatile oeth_bd*) &tx_bd[next_tx_buf_num];

  // If it's in use - wait

  while ((tx_bd->len_status & OETH_TX_BD_IRQ));

#ifndef _ETH_RXTX_DATA_H_  

  /* Copy the data into the transmit buffer, byte at a time */

  char* data_b = (char*) tx_bd->addr;

  for(i=0;i<size;i++)

    {

      data_b[i] = gen_next_tx_byte();

    }

#endif

  tx_packet((void*)0, size);

}

// Loop to check if a number is prime by doing mod divide of the number

// to test by every number less than it

int

is_prime_number(unsigned long n)

{

  unsigned long c;

  if (n < 2) return 0;

  for(c=2;c<n;c++)

    if ((n % c) == 0)

      return 0;

  return 1;

}

//#define WAIT_PACKET_TX(x) while(tx_done<x)

#define WAIT_PACKET_TX(x)

int main ()

{

  tx_data_pointer = 0;

  /* Initialise handler vector */

  int_init();

  /* Install ethernet interrupt handler, it is enabled here too */

  int_add(ETH0_IRQ, oeth_interrupt, 0);

  /* Enable interrupts in supervisor register */

  mtspr (SPR_SR, mfspr (SPR_SR) | SPR_SR_IEE);

  ethmac_setup(); /* Configure MAC, TX/RX BDs and enable RX and TX in MODER */

  /* clear tx_done, the tx interrupt handler will set it when it's been

     transmitted */

  tx_done = 0;

  rx_done = 0;

  printf("Start of large txdata buffer: 0x%x\n",

         (unsigned long)&tx_data_array[0]);

  printf("Slut of large txdata buffer: 0x%x\n",

         (unsigned long)&tx_data_array[262144]);

  ethphy_set_100mbit(0);

  oeth_enable_rx();