Subversion Repositories wdsp

/*FFT-Core test*/

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

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

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

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

#define FFT_BASE 0x94000000

#define FFT_CONTROL 0

#define FFT_DATA 4

#define FFT_STATUS 8

#define FFT_MEMORY 12

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)&0xff);

 }

}

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);

  }

}

char str[100];

int main()

{

int c,k,j,r_in,r_out,DAT0,DAT1,DAT2;

        uart_init();

        int_init();

        int_add(UART_IRQ,&uart_interrupt);

        uart_print_str("FFT-Test\n");

         /*clears status register and FFT-core*/

        REG32(FFT_BASE+FFT_CONTROL)=1;

        /*Test data for FFT*/

        /*MATLAB command: int16((fft([-1100 1024 zeros(1,1022)])/16)).' */

        DAT0=-1100;  DAT1=1024; DAT2=0;

        /*real part in MSW, imaginary part (zero) in LSW*/

        REG32(FFT_BASE+FFT_DATA)=(DAT0)<<16;

        REG32(FFT_BASE+FFT_DATA)=(DAT1)<<16;

        /*Pipeline fill*/

        for(k=1;k<=2046;k=k+1) {

        REG32(FFT_BASE+FFT_DATA)=(DAT2);

        };

        /*Waits for FFT core*/

        while(REG32(FFT_BASE+FFT_STATUS)==0) ;

        /*reads FFT results */

        for(k=0;k<=(1023);k++) {

            r_out=REG32(FFT_BASE+FFT_MEMORY+4*k);

           /*prints real part*/

           int10_to_str(r_out>>16,str,-10);

           uart_print_str(str);

           /*prints imaginary part*/

           uart_putc('+');

           int10_to_str((r_out<<16)>>16,str,-10);

           uart_print_str(str);

           uart_print_str("*j");

           uart_putc(' ');

        };

        report(0xdeaddead);

        or32_exit(0);

}