main.c

DSP实现蝶形FFT算法 为某开发板公司5509开发板资料

#include "myapp.h"
//#include "ICETEK-VC5509-A.h"
#include "LCD.h"
#include "math.h"
#include "extaddr.h"
#include "util.h"

#define CREG (*(unsigned short int *)0x400004)
#define PI 3.1415926
#define SAMPLENUMBER 128

// AD  ----------------------------------------------------------
ioport unsigned int *ADCCTL1=(unsigned int *)0x6800;
ioport unsigned int *ADCDATA1=(unsigned int *)0x6801;
ioport unsigned int *ADCCLKDIV1=(unsigned int *)0x6802;
ioport unsigned int *ADCCLKCTL1=(unsigned int *)0x6803;
#define ADCCTL (*ADCCTL1)
#define ADCDATA (*ADCDATA1)
#define ADCCLKDIV (*ADCCLKDIV1)
#define ADCCLKCTL (*ADCCLKCTL1)
// DA  ----------------------------------------------------------
#define DA_DATA_L   (*((unsigned int *)0x400800))
#define DA_DATA_H   (*((unsigned int *)0x400801))
#define DA_CTL      (*((unsigned int *)0x400802))
#define DA_CHN1      0x0
#define DA_CHN2      0x40 
#define DA_CHN3      0x80
#define DA_CHN4      0xc0
// 液晶  ----------------------------------------------------------
#define CTRLED (*(unsigned int *)0x600802) // port8004
#define MCTRKEY (*(unsigned int *)0x602802)  // port8005
#define CTRCLKEY (*(unsigned int *)0x600803) // port8006
#define CTRSTATUS (*(unsigned int *)0x600800) //port8000

#define ADCNUMBER 256

void TIME_init(void);
void INTR_init( void );
void interrupt Timer( void );
void InitADC();
void InitForFFT();
void MakeWave();
void FFT(float dataR[SAMPLENUMBER],float dataI[SAMPLENUMBER]);

ioport unsigned int * sysR = (unsigned int *)0x7fd;

struct struLCDGraph struGraph,struGraph1;
unsigned int nScreenBuffer[30*128];
int nData[256],nData1[256];
void Delay(unsigned int nDelay);
int k0,k1,uWork,uWork0,nAD,keyflage;
int nGraphBuf1[ADCNUMBER],nGraphBuf2[ADCNUMBER];
int nADBuf1[ADCNUMBER],nADBuf2[ADCNUMBER];
int nGraphBuf1[ADCNUMBER],nGraphBuf2[ADCNUMBER];

int INPUT[SAMPLENUMBER],DATA[SAMPLENUMBER];
float fWaveR[SAMPLENUMBER],fWaveI[SAMPLENUMBER],w[SAMPLENUMBER];
float sin_tab[SAMPLENUMBER],cos_tab[SAMPLENUMBER];
main()
{


	int i,j;
	unsigned int * pWork;
    unsigned int uWork1;
    
	CLK_init();
	//PLL_Init(48);
	SDRAM_init();
	CREG=1;
    LCDTurnOff();
	LCDSetScreenBuffer(nScreenBuffer);
	for ( uWork=0,pWork=nScreenBuffer;uWork<30*128;uWork++,pWork++ )	(*pWork)=0;
	LCDSetDelay(1);
	LCDTurnOn();				// 打开显示
	LCDCLS();				// 清除显示内存  
	
	TIME_init();
    INTR_init(); 
    
    InitADC();
    ADCCTL = 0x8000;
    (*sysR)=1;
    k0=k1=0;
    keyflage=0;


	for(;;)
	{
      if(keyflage==0)
      {
	     struGraph.pData=nGraphBuf1;
	     struGraph.uDataMode=DATAUINTMODE;
	     struGraph.uDataLength=ADCNUMBER;
	     struGraph.uMaxValue=1024;
	     struGraph.uWindowX0=0;
	     struGraph.uWindowY0=0;
	     struGraph.uWindowX1=240;
	     struGraph.uWindowY1=128;
	     struGraph.nOriginX=0;
	     struGraph.nOriginY=0;
	     struGraph.uLineMode=LINEMODE;
	     LCDGraph(&struGraph);
	     for ( j=0;j<20;j++ )	_Delay(614);
	     LCDSetScreenBuffer(nScreenBuffer);
	     LCDCLS();				// 清除显示内存
	   } 
	   if(keyflage==1)
	   {  
	     struGraph.pData=DATA;
	     struGraph.uDataMode=DATAUINTMODE;
	     struGraph.uDataLength=SAMPLENUMBER;
	     struGraph.uMaxValue=65535;
	     struGraph.uWindowX0=0;
	     struGraph.uWindowY0=0;
	     struGraph.uWindowX1=240;
	     struGraph.uWindowY1=128;
	     struGraph.nOriginX=0;
	     struGraph.nOriginY=0;
	     struGraph.uLineMode=LINEMODE;
	     LCDGraph(&struGraph);
	     for ( j=0;j<20;j++ )	_Delay(614);
	     LCDSetScreenBuffer(nScreenBuffer);
	     LCDCLS();				// 清除显示内存
	   }
	   
	   uWork1=MCTRKEY;
	   CTRCLKEY=0;
	   if(uWork1==128)
	   {		
		    keyflage=1-keyflage;
	   }
	     
	     
	     InitForFFT();
	     MakeWave();
	     for ( i=0;i<SAMPLENUMBER;i++ )
	     {
		     fWaveR[i]=INPUT[i];
		     fWaveI[i]=0.0f;
		     w[i]=0.0f;
	     }
	     FFT(fWaveR,fWaveI);
	     for ( i=0;i<SAMPLENUMBER;i++ )
	     {
		     DATA[i]=w[i];
	     }
	}
	
}



void TIME_init(void)
{
    ioport unsigned int *tim0; 
    ioport unsigned int *prd0; 
    ioport unsigned int *tcr0; 
    ioport unsigned int *prsc0;  
	tim0  =  (unsigned int *)0x1000;
	prd0  =  (unsigned int *)0x1001;
	tcr0  =  (unsigned int *)0x1002;
	prsc0 =  (unsigned int *)0x1003;
   *tcr0 = 0x04f0;
   *tim0 = 0;
   *prd0 = 0x03ff;
   *prsc0 = 2;
   *tcr0 = 0x00e0;


}



void INTR_init( void )
{
	IVPD=0xd0;
	IVPH=0xd0;
	IER0=0x10;
	DBIER0 =0x10;
	IFR0=0xffff;
	asm(" BCLR INTM");

}

void interrupt Timer( void )
{        
        uWork0=ADCDATA;		// 从FIFO中读取转换结果
		uWork=uWork0&0x0f000;
		if ( uWork==0 )
		{
			uWork0&=0x0fff;		// 去掉高4位
			nADBuf1[k0++]=uWork0;	// 保存结果
			DA_DATA_L=uWork0&0xff;
		    DA_DATA_H=((uWork0>>8)&0x0f)|DA_CHN1;
		    DA_CTL=0;		   
			if ( k0>=ADCNUMBER )
			{
				for ( nAD=0;nAD<k0;nAD++ )
				{
					nGraphBuf1[nAD]=nADBuf1[nAD];//+2048;//+1352;
					nGraphBuf1[nAD]&=0x0fff;
				}
				for ( nAD=k0;nAD<ADCNUMBER;nAD++ )
				{
					nGraphBuf1[nAD]=nADBuf1[k0-1];//+2048;//+1352;
					nGraphBuf1[nAD]&=0x0fff;
				}

				k0=0;
			}
			ADCCTL = 0x8000;
	    //ADCCTL = 0x9000;	// 发送控制脉冲信号，进行下次转换 1通道只需送0x9000即可
		}
		
}

void InitADC()
{
	ADCCLKCTL=0x1; 
	ADCCLKDIV=0x1f00;
}

void FFT(float dataR[SAMPLENUMBER],float dataI[SAMPLENUMBER])
{
	int x0,x1,x2,x3,x4,x5,x6,xx;
	int i,j,k,b,p,L;
	float TR,TI,temp;
	
	/********** following code invert sequence ************/
	for ( i=0;i<SAMPLENUMBER;i++ )
	{
		x0=x1=x2=x3=x4=x5=x6=0;
		x0=i&0x01; x1=(i/2)&0x01; x2=(i/4)&0x01; x3=(i/8)&0x01;x4=(i/16)&0x01; x5=(i/32)&0x01; x6=(i/64)&0x01;
		xx=x0*64+x1*32+x2*16+x3*8+x4*4+x5*2+x6;
		dataI[xx]=dataR[i];
	}
	for ( i=0;i<SAMPLENUMBER;i++ )
	{
		dataR[i]=dataI[i]; dataI[i]=0; 
	}

	/************** following code FFT *******************/
	for ( L=1;L<=7;L++ )
	{ /* for(1) */
		b=1; i=L-1;
		while ( i>0 ) 
		{
			b=b*2; i--;
		} /* b= 2^(L-1) */
		for ( j=0;j<=b-1;j++ ) /* for (2) */
		{
			p=1; i=7-L;
			while ( i>0 ) /* p=pow(2,7-L)*j; */
			{
				p=p*2; i--;
			}
			p=p*j;
			for ( k=j;k<128;k=k+2*b ) /* for (3) */
			{
				TR=dataR[k]; TI=dataI[k]; temp=dataR[k+b];
				dataR[k]=dataR[k]+dataR[k+b]*cos_tab[p]+dataI[k+b]*sin_tab[p];
				dataI[k]=dataI[k]-dataR[k+b]*sin_tab[p]+dataI[k+b]*cos_tab[p];
				dataR[k+b]=TR-dataR[k+b]*cos_tab[p]-dataI[k+b]*sin_tab[p];
				dataI[k+b]=TI+temp*sin_tab[p]-dataI[k+b]*cos_tab[p];
			} /* END for (3) */
		} /* END for (2) */
	} /* END for (1) */
	for ( i=0;i<SAMPLENUMBER/2;i++ )
	{ 
		w[i]=sqrt(dataR[i]*dataR[i]+dataI[i]*dataI[i]);
	}
} /* END FFT */


void InitForFFT()
{
	int i;
	
	for ( i=0;i<SAMPLENUMBER;i++ )
	{
		sin_tab[i]=sin(PI*2*i/SAMPLENUMBER);
		cos_tab[i]=cos(PI*2*i/SAMPLENUMBER);
	}
}

void MakeWave()
{
	int i;
	
	for ( i=0;i<SAMPLENUMBER;i++ )
	{
		INPUT[i]=nGraphBuf1[i];
	}
}