📄 fft.c
字号:
/*********************************************************************************
* fft.c SEED-DTK APD的fft 实验主程序 *
* 版权(c) 2004- 北京合众达电子技术有限责任公司 *
* 设计者： 耿升辉 *
**********************************************************************************/
#include "string.h"
#include "UART_func.h"
#include "SEED-DEC2407.h"
#include "comm.h"
#include "math.h"
#include "stdio.h"
#include "tms320.h"
#include "dsplib.h"
#include "fft.h"
/*帧长度的设定*/
#define FRAMLONGTH 0x104
#define DataLongth 0x100
#define TWON128 128 /* Real FFT Length */
#define TWON256 256 /* Real FFT Length */
#define TWON512 512 /* Real FFT Length */
#pragma DATA_SECTION(ipcb, "FFTipcb");
int ipcb[512]; /* In place computation buffer */
FFT128R fft128=FFT128R_DEFAULTS;
FFT256R fft256=FFT256R_DEFAULTS;
FFT512R fft512=FFT512R_DEFAULTS;
typedef struct _UartForDec5416{
unsigned int Length;
unsigned int Type;
unsigned int Mutul;
unsigned int Data[DataLongth];
unsigned int Check;
}UartForDec5416, *PuartForDec5416;
PuartForDec5416 precieve =0;
unsigned long i= 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;
PMotorConfig pmotor = 0;
unsigned int errorsend = 0;
volatile unsigned int uart[0x104] ={0};
unsigned int Ad_data[1536]={0};
volatile unsigned int uarts[0x104] = {0};
volatile unsigned int adset[4] ={512,0xd,0,0};
PAdConfig padset = 0;
volatile unsigned int datasendlong = 0;
volatile unsigned int datasendlength = 0;
volatile unsigned int sendcount = 0;
unsigned int convcount = 0;
volatile unsigned int adconvover =0;
volatile unsigned int convtimes=60;
volatile unsigned int convtimesback=60;
unsigned int uart_send(void);
unsigned int temp,r = 0;
unsigned int mod[512];
int m=0;
double n;
double p,q;
void SystemInit(void);
void PHANTOM(void);
void init_UART(void);
void AdInit(void);
void Ad8kInit(void);
void Ad44kInit(void);
void Ad96kInit(void);
int uart_recive(void);
void sys_reset(void);
void main(void)
{
ONLED;//打开led
DINT;//关中断
SystemInit();//系统初始化
init_UART();//串口初始化
*IFR = 0x3f;
*IMR = 0x21;
EINT; //开中断
/*实验主控程序*/
psend = (PuartForDec5416)(&uarts[0]);
precieve = (PuartForDec5416)(&uart[0]);
padset = (PAdConfig)(&adset[0]);
/*通知主机，系统准备好*/
psend->Length = FRAMLONGTH;
psend->Type = UARTCOMMAND;
psend->Data[0] = INITOVER;
psend->Mutul = UARTCONT;
uart_send();
for(;;)
{
uart_s =uart_recive();
/* 返回值 0:接受完成 */
/* 1：数据未准备好 */
/* -1:串口接受错误 */
/* 2：中断超时错误 */
/* 3: 较验出错 */
if(uart_s ==0)
{
/*不是命令帧*/
if(precieve->Type != UARTCOMMAND)
{
/*无效命令*/
psend->Length = FRAMLONGTH;
psend->Type = UARTCOMMAND;
psend->Data[0] = COMMANDNODO;
psend->Mutul = UARTCONT;
uart_send();
precieve->Type = UARTCOMMAND;
continue;
}
}
/*接收从主机的数据*/
precieve = (PuartForDec5416)(&uart[0]);
switch(precieve->Data[0])
{
/*fft设置*/
case FFTSET:
for(i=0;i<3;i++)
{
adset[i] = precieve->Data[i+1];
}
/*设置数据发送长度*/
datasendlong = padset->SampleLong;
datasendlength= 3*datasendlong/2;
precieve->Data[0] = 0;
break;
/*启动FFT采样和计算*/
case FFTSTART:
convcount=0;
adconvover=0;
sendcount=0;
datasendlength= 3*datasendlong/2;
/*AD采样率*/
switch( padset->SampleRate)
{
case ADSAMPL8K: //0xd //采样率为8k
convtimes=24;
convtimesback=24;
break;
case ADSAMPL44K: // 0x23 //采样率为44k
convtimes=4;
convtimesback=4;
break;
case ADSAMPL96K://0x1d //采样率为96k
convtimes=2;
convtimesback=2;
break;
default:
break;
}
AdInit();
for(;;)
{
if (adconvover==1)
{
break;
}
}
/*AD采样结束*/
/*fft转换*/
for(i=0;i<datasendlong;i++)
{
Ad_data[i]=(Ad_data[i]>>6)-0x136;
ipcb[i] = Ad_data[i];
}
/* FFT initialization */
switch(datasendlong)
{
case 128:
fft128.ipcbptr=ipcb; /* FFT computation buffer */
/* Acquire samples in bit reversed order or
Bit-reverse the in- order data using bit-rev utility */
/* FFT Computation */
FFTR_brev(ipcb,ipcb,64);
fft128.calc(&fft128); /* Zero the imaginary part */
fft128.split(&fft128); /* Compute the FFT */
break;
case 256:
fft256.ipcbptr=ipcb; /* FFT computation buffer */
/* Acquire samples in bit reversed order or
Bit-reverse the in- order data using bit-rev utility */
FFTR_brev(ipcb,ipcb,128);
/* FFT Computation */
fft256.calc(&fft256); /* Zero the imaginary part */
fft256.split(&fft256); /* Compute the FFT */
break;
case 512:
fft512.ipcbptr=ipcb; /* FFT computation buffer */
/* Acquire samples in bit reversed order or
Bit-reverse the in- order data using bit-rev utility */
FFTR_brev(ipcb,ipcb,256);
/* FFT Computation */
fft512.calc(&fft512); /* Zero the imaginary part */
fft512.split(&fft512); /* Compute the FFT */
break;
default:
break;
}
/*求模*/
m=0;
for(i=0;i<datasendlong;i+=2)
{
p=ipcb[i];
q=ipcb[i+1];
n=p*p+q*q;
mod[m]=sqrt(n);
m++;
}
r= datasendlong;
for(i=0;i<datasendlong/2;i++)
{
Ad_data[r]=mod[i];
r++;
}
//FFT计算完毕
psend->Length = 1;
psend->Type = UARTCOMMAND;
psend->Data[0] = FFTOVER;
psend->Mutul = UARTCONT;
uart_send();
precieve->Data[0] = 0;
break;
/*fft数据传送*/
case FFTDATASEND:
/*不满256的数据*/
if(datasendlength <= 256)
{
for(i = 0;i<datasendlength;i++)
{
psend->Data[i] = Ad_data[i+sendcount*256];
}
psend->Length = datasendlength;
psend->Type = UARTDATA;
psend->Mutul = UARTCONT;
uart_send();
precieve->Data[0] = 0;
break;
}
/*满256数据*/
for(k = 0; k<256;k++)
{
psend->Data[k] = Ad_data[k+sendcount*256];
}
psend->Length = 256;
psend->Type = UARTDATA;
psend->Mutul = UARTMUTL;
uart_send();
datasendlength= datasendlength - 256;
sendcount++;
precieve->Data[0] = 0;
break;
case RECIEVEERROR:
datasendlength = datasendlength + 256;
sendcount--;
precieve->Data[0] = ADDATASEND;
break;
/*系统复位*/
case SYSRESET:
precieve->Data[0] = 0;
/* reset adc */
*ADCTRL1 = 0x4000; //RESET ADC
*ADCTRL2 = 0x4000;// reset sequencer to state CONV00
*MAXCONV = 0;// Number of conversions =1
sys_reset();
NOP;
break;
default:
break;
}
}
}
void SystemInit(void)
{
WSGR = 0x80;
*WDCR = 0x68;
*SCSR1 = 0x080; //40MHZ
*MCRA = 0x04;
*XINT1CR = 0x01;
}
void AdInit(void)
{
/* reset adc */
*ADCTRL1 = 0x4000; //RESET ADC
*ADCTRL2 = 0x4000;// reset sequencer to state CONV00
*MAXCONV = 0;// Number of conversions =1
NOP;
/* run,seq casc operation */
*ADCTRL1 = 0x3030;
*MAXCONV = 0x00;//
*CHSELSEQ1 = 0x3210;
*CHSELSEQ2 = 0x7654;
*CHSELSEQ3 = 0xBA98;
*CHSELSEQ4 = 0xFEDC;
*ADCTRL2 = 0x2600;
}
void PHANTOM(void)
{
}
void init_UART(void)
{
UARTA_LCR = (data_w8+data_s1+LC_1_DLAB); /*8位数据 1停止位 不校验 开启除数转换*/
UARTA_DLL = buad_19k2_l; /*9.6K波特率*/
UARTA_DLH = buad_19k2_h;
UARTA_LCR = (data_w8+data_s1+LC_0_DLAB); /*8位数据 1停止位 不校验 关闭其余寄存器转换*/
UARTA_MCR = UartLoop;
UARTA_FCR = fifo_reset;
UARTA_FCR = fifo_enable+fifo_txdip8+fifo_rxdip8;//TRIGLE level ＝8
UARTA_IER = uartint_rhr;
for(i= 0; i<0x104;i++)
{
uart[i] = 0;
uarts[i] = 0;
}
for(i=0;i<32;i++)
{
sys_statbuff[i]=0;//系统标志buff清0
}
}
interrupt void c_int1(void)//串口接收中断
{
int i;
DINT;
if((*PIVR & 0x01) == 0x01)//xint1中断
{
if((INT1_RD & 0x02) == 0x02)//uarta中断
{
temp=UARTA_LSR;//读一次lsr，第一次读有可能有误。
temp=UARTA_LSR;
for(i=0;i<8;i++)//fifo有8个字节等待读。
{
if (((temp&0x1e)==0)&&((temp&0x01)==1))//无串口接收错误
{
uarta_recbuff[sys_statbuff[RECAADDR]]=UARTA_RHR&0xff;//接收数据
sys_statbuff[RECAADDR]++;
}
else
{
sys_statbuff[UARTAERR]=1;//错误标志为1
sys_statbuff[RECAADDR]=0;//缓冲区接收位置清0
break;//中止循环
}
}//for(i=0;i<8;i++)//fifo有8个字节等待读
UARTA_FCR = fifo_rreset;//3rest r fifo,enable fifo
if(sys_statbuff[RECAADDR]==FRAMLONGTH*2)//满帧
{
if (sys_statbuff[RECANEW]==1)//上一帧新帧标志仍未清除
{
sys_statbuff[UARTIMEA]=1;//超时错误置一
}
sys_statbuff[RECANEW]=1;//新帧标志置一
sys_statbuff[RECAADDR]=0;//缓冲区接收位置清0
//转移到uart[]。
for(i=0;i<FRAMLONGTH;i++)
{
uart[i]=(uarta_recbuff[i*2]<<8)+uarta_recbuff[i*2+1];
}
}
if(sys_statbuff[RECAADDR]>FRAMLONGTH*2)//超帧
{
sys_statbuff[RECAADDR]=0;//缓冲区接收位置清0
}
}//if((INT1_RD & 0x02) == 0x02)//uarta中断
*XINT1CR = *XINT1CR | 0x8000;
} //if((*PIVR & 0x01) == 0x01)//xint1中断
}
interrupt void c_int6(void)
{
NOP;
DINT;
if(*PIVR == 0x4)
{
convtimes--;
if(convtimes==0)
{
convtimes=convtimesback;
Ad_data[convcount] = *RESULT0;
convcount++;
if (convcount==padset->SampleLong)
{
convcount=0;
adconvover=1;//接满标志
}
else
{
//reset sequencer to state CONV00
//清除中断状态位
*ADCTRL2 = *ADCTRL2 | 0x4000;
NOP;
NOP;
*ADCTRL2 = *ADCTRL2 | 0x2000;
}
}
else
{
//reset sequencer to state CONV00
//清除中断状态位
*ADCTRL2 = *ADCTRL2 | 0x4000;
NOP;
NOP;
*ADCTRL2 = *ADCTRL2 | 0x2000;
}
}
}
/* 返回值 0:接受完成 */
/* 1：数据未准备好 */
/* -1:串口接受错误 */
/* 2：中断超时错误 */
/* 3: 较验出错 */
int uart_recive(void)
{
int check;
/*判断串口是否故障*/
if(sys_statbuff[UARTAERR] != 0)
{
sys_statbuff[UARTAERR]=0;
return -1;
}
/*数据未准备好*/
if(sys_statbuff[RECANEW] != 1)
{
return 1;
}
sys_statbuff[RECANEW]=0;//新帧标志位清零
check=0;
for(i=0;i<FRAMLONGTH-1;i++)
{
check=check ^ uart[i];
}
if(check!=uart[FRAMLONGTH-1])//校验不正确
{
return 3;
}
return 0;
}
unsigned int uart_send(void)
{
unsigned int i;
unsigned int send_datah;
unsigned int timeout = 0x4000;
unsigned int check = 0;
for(i = 0; i<FRAMLONGTH-1; i++)
{
for(;;)
{
timeout--;
temp=UARTA_LSR;
/*上一次发送是否完成*/
if(UARTA_LSR & 0x40)
{
/*发送数据的高8位*/
send_datah = uarts[i];
check = check ^ (send_datah);
UARTA_THR = send_datah>>8;
break;
}
/*检查是否超时*/
if(!(timeout))
{
return 0xFFFF;
}
}
timeout = 0x4000;
for(;;)
{
timeout--;
/*上一次发送是否完成*/
if(UARTA_LSR & 0x40)
{
/*发送数据的低8位*/
UARTA_THR = uarts[i];
break;
}
/*检查是否超时*/
if(!(timeout))
{
return 0xFFFF;
}
}
}
/*发送校验结果*/
for(;;)
{
timeout--;
/*上一次发送是否完成*/
if(UARTA_LSR & 0x40)
{
/*发送数据的高8位*/
send_datah = (check>>8);
UARTA_THR = send_datah;
break;
}
/*检查是否超时*/
if(!(timeout))
{
return 0xFFFF;
}
}
timeout = 0x4000;
for(;;)
{
timeout--;
/*上一次发送是否完成*/
if(UARTA_LSR & 0x40)
{
/*发送数据的低8位*/
UARTA_THR = check;
break;
}
/*检查是否超时*/
if(!(timeout))
{
return 0xFFFF;
}
}
uarts[FRAMLONGTH-1]=check;
return 0;
}
void sys_reset(void)
{
WSGR = 0;
*WDCR = 0x08;
for(;;){};
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -