dtk-fft.c

seed傅立叶变换程序

/*********************************************************************************
*  MCPSB.C	v1.00   测试MCBSP同步串口测试的主程序	                             *
*  版权(c) 	2003-		北京合众达电子技术有限责任公司			                 *
*  设计者：	段立锋								                                 *
**********************************************************************************/
#include "type.h"
#include "codec.h"
#include "uart.h"
#include "sysreg.h"
#include "mcbsp54.h"
#include "memory.h"
#include "comm.h"

#include "math.h"
#include "stdio.h"
#include "tms320.h"
#include "dsplib.h"

/*帧长度的设定*/
#define  FRAMLONGTH    0x104

#define  DataLongth   0x100

typedef struct _UartForDec5416{
	unsigned int Length;
	unsigned int Type;
	unsigned int Mutul;
	unsigned int Data[DataLongth];
	unsigned int Check;
}UartForDec5416, *PuartForDec5416; 

HANDLE uart_a =0;
HANDLE codec_command =0;
HANDLE codec_data=0;
unsigned int audiodata =0;
PuartForDec5416 precieve =0;	
unsigned int i= 0,r = 0;
unsigned int k= 0;
int uart_s=0,uart_err=0,fifostatus=0;
unsigned long flashbaddr=0;
unsigned long flashaddr = 0;
PuartForDec5416 psend=0;
PAdConfig padset = 0;
unsigned int datasendlong = 0;
unsigned int datasendlength = 0;
unsigned int sendcount = 0;
unsigned int errorsend = 0;
unsigned int adset[4] ={1024,0xd,0,0};
DATA dataleft[1536] ={0};
unsigned int dataright[1536] ={0};
unsigned int uart[0x104] ={0};
unsigned int uarts[0x104] = {0};

#pragma DATA_SECTION (fft_data,".result")
DATA    fft_data[1024];
unsigned int    mod[512];
ushort  datacbrev=0;
    int  m=0;
    double  n;
	double p,q;



main()
{	
  //  int  i,r;
	
	/*设置系统时钟*/
	sys_clk(CLK160);
	/*初始化DEC5416板卡*/
	dec5416_init();
	for(i= 0; i<0x104;i++)
	{
		uart[i] = 0x5555;
		uarts[i] = 0x5555;
	}
	/*打开codec数据接口*/
	codec_data = codec_open(CODEC_DATA);
	/*打开codec命令接口*/
	codec_command = codec_open(CODEC_COMMAND);

	/*设置波特率,输入与输出均为8K*/
	codec_sample_rate(codec_command,0xd);
	
	/*获取有效的串口句柄*/
	uart_a = uart_open(UART_A);
	/*初始化串口*/
	uart_setup(uart_a,    /*串口A*/
			   buad_19k2,  /*串口的波特率设置*/
			   data_w8,   /*数据长度为8*/ 
			   data_s1,   /*数据停止位为1*/ 
			   //uart_parity,    /*设置奇较验位*/	 
			   0,
			   (fifo_enable+fifo_txdip16+fifo_rxdip16),/*FIFO设置*/ 
			   0);       /*设置自闭环方式*/		   
	/*串口A中断设置*/		   
	uart_interrupt_control( uart_a, uartint_rhr, uart_enable);
	/*设置接收长度*/
	uart_reclong_set(uart_a,FRAMLONGTH);
	/*打开系统的串口中断*/
	sysint_enable(0x2);
	
	/*配置系统存储器*/	
	memory_set(0x80);
	
	/*实验主控程序*/
	psend =  (PuartForDec5416)(&uarts[0]);
	padset = (PAdConfig)(&adset[0]);
	/*通知主机，系统准备好*/
	psend->Length = FRAMLONGTH;
	psend->Type = UARTCOMMAND;
	psend->Data[0] = INITOVER;
	psend->Mutul = UARTCONT;
	uart_send(uart_a,FRAMLONGTH, (unsigned int *)psend);
	for(;;)
	{	
		uart_recive(uart_a,&uart[0]);
		/*判断串口的状态*/
		uart_s =uart_status(uart_a);
		if( uart_s == 2)
		{
			/*读RHR清 RHR interrupt*/
			uart_read_reg(uart_a,rhr);
			/*复位FIFO指针*/
			fifostatus = uart_read_reg(uart_a,fcr);
			uart_write_reg(uart_a,fcr,fifo_rreset);
			uart_write_reg(uart_a,fcr,fifostatus);
			continue;	
		}
		/*串口出错*/
		if(uart_s == ERROR)
		{
			/*读状态寄存器*/
			uart_err = uart_read_reg(uart_a,lsr);
			/*复位FIFO指针*/
			fifostatus = uart_read_reg(uart_a,fcr);
			uart_write_reg(uart_a,fcr,fifo_rreset);
			uart_write_reg(uart_a,fcr,fifostatus);
			
			continue;
		}
		/*数据较验出错*/
		if(uart_s == 3)
		{
			/*通知主机程序通讯出错,准备重发*/
			psend->Length = FRAMLONGTH;
			psend->Type = UARTCOMMAND;
			psend->Data[0] =  RECIEVEERROR;
			psend->Mutul = UARTCONT;
			uart_send(uart_a,FRAMLONGTH, (unsigned int *)psend);
			continue;	
		}
		/*数据未准备好*/
		if(uart_s == 0)
		{
			precieve = (PuartForDec5416)(&uart[0]);
			/*不是命令帧*/
			if(precieve->Type != UARTCOMMAND)
			{
				/*无效命令*/
				psend->Length = FRAMLONGTH;
				psend->Type = UARTCOMMAND;
				psend->Data[0] =  COMMANDNODO;
				psend->Mutul = UARTCONT;
				uart_send(uart_a,FRAMLONGTH, (unsigned int *)psend);
				precieve->Data[0] = 0;	
			}
			continue;
		}
		
    	
		/*接收从主机的数据*/
		precieve = (PuartForDec5416)(&uart[0]);
		switch(precieve->Data[0])
		{
			/*AD设置*/
			case FFTSET:
				for(i=0;i<3;i++)
				{
					adset[i] = precieve->Data[i+1];
				}
				/*设置数据发送长度*/
				datasendlong = padset->SampleLong;
				datasendlength= 3*datasendlong/2;
				/*AD前向增益调整*/	
				codec_lineain_gain(codec_command, padset->GainSet);
				/*AD采样率*/
				codec_sample_rate(codec_command, padset->SampleRate);
				precieve->Data[0] = 0;
				break;
				
			/*启动AD采样*/	
			case FFTSTART:
			sendcount = 0;
			datasendlength= 3*datasendlong/2;
			for(i = 0;i<padset->SampleLong;)
				{
					/* Wait for sample from handset */
	   				while (!MCBSP_RRDY(CODEC_DATA)) {};
	   				/* Read sample from and write back to handset codec */
	   				/*左通路数据*/
					dataleft[i] = *(volatile u16*)DRR1_ADDR(CODEC_DATA); 
		            
					/* Wait for sample from handset */
	   				while (!MCBSP_RRDY(CODEC_DATA)) {};
	   				/*右通路数据*/
					dataright[i] =  *(volatile u16*)DRR1_ADDR(CODEC_DATA);
					fft_data[i] = dataright[i];
					i = i+1;
				}
				/*fft转换*/
				for(i=0;i<datasendlong;i++)
				{
					fft_data[i] = dataleft[i];
				}	
			
		       switch(datasendlong)
		       {
		         case 256:
		         	
				 /*256 point*/
				     cbrev(fft_data,fft_data,128);
                     rfft(fft_data,256,256);
                     break;
                 case 512: 
                  /*512 point*/  
                     cbrev(fft_data,fft_data,256);
                     rfft(fft_data,512,512);
                     break;
                 case 1024:  
                  /*1024 point*/  
                     cbrev(fft_data,fft_data,512);
                     rfft(fft_data,1024,1);
                     break;
               }      
                    
                 /*求模*/   
                   m=0;
                for(i=0;i<datasendlong;i+=2)
                {  
                   p=fft_data[i];
                   q=fft_data[i+1];                      
                   n=p*p+q*q;  
                   mod[m]=sqrt(n);	
                	m++;                           
                }
                r= datasendlong;    
                 /* dataleft(dataright)[]=addata[]+mod[]*/
                for(i=0;i<datasendlong/2;i++)
                     {
                       dataleft[r]=mod[i];
                       dataright[r]=mod[i];
                       r++;
                       }
				/*AD采样结束*/
				psend->Length = 1;
				psend->Type = UARTCOMMAND;
				psend->Data[0] =  FFTOVER;
				psend->Mutul = UARTCONT;
				uart_send(uart_a,FRAMLONGTH, (unsigned int *)psend);
				precieve->Data[0] = 0;
				break;
					
			/*AD数据传送*/		
			case FFTDATASEND:
			    if(datasendlength <=256)
				{
					for(i = 0;i<datasendlength;i++)
					{
						/*确定通路*/
						if(padset->DataLeft == ADDATALEFT)
						{
							psend->Data[i] = dataleft[i+sendcount*256];
						}
						else
						{
							psend->Data[i] = dataright[i+sendcount*256];
						}
					}
					psend->Length = datasendlength;
					psend->Type = UARTDATA;
					psend->Mutul = UARTCONT;
					uart_send(uart_a,FRAMLONGTH, (unsigned int *)psend);
					precieve->Data[0] = 0;
					break;	
				}
			    for(k = 0; k<256 ; k++)
			    {
			    	/*确定通路*/
					if(padset->DataLeft == ADDATALEFT)
					{
						psend->Data[k] = dataleft[k + sendcount*256];
					}
					else
					{
						psend->Data[k] = dataright[k+ sendcount*256];
					}
			    }
			    psend->Length = 256;
				psend->Type = UARTDATA;
				psend->Mutul = UARTMUTL;
				uart_send(uart_a,FRAMLONGTH, (unsigned int *)psend);
			
			  	datasendlength = datasendlength - 256;
			  	sendcount++; 
			    precieve->Data[0] = 0;
				break;
			case RECIEVEERROR:
				datasendlength= datasendlength + 256;
				sendcount--;
				precieve->Data[0] = FFTDATASEND;
				break;
				 					
			/*系统复位*/
			case SYSRESET:
				sys_set(0x4);
				precieve->Data[0] =0;
				break;
			
			default:
				break;
		} 		
	}							     
}