|
楼主 |
发表于 2011-2-8 17:24:46
|
显示全部楼层
呵呵,上面是功率谱。。改了下,,现在是电压谱,感觉电压普好看些。。。
#include<STC12C5A.H>
#define uchar unsigned char
#define uint unsigned int
#define channel 0x01
//---------------------------------------------------------------------
sbit SDA_R=P1^2;
sbit SDA_R_TOP=P1^3;
sbit SDA_G=P1^4;
sbit SDA_G_TOP=P1^5;
sbit STCP=P1^6;
sbit SHCP=P1^7;
//----------------------------------------------------------------------------------------------------------------------
//放大128倍后的sin整数表(128)
code char SIN_TAB[128] = { 0, 6, 12, 18, 24, 30, 36, 42, 48, 54, 59, 65, 70, 75, 80, 85, 89, 94, 98, 102,
105, 108, 112, 114, 117, 119, 121, 123, 124, 125, 126, 126, 126, 126, 126, 125, 124, 123, 121, 119, 117, 114, 112,
108, 105, 102, 98, 94, 89, 85, 80, 75, 70, 65, 59, 54, 48, 42, 36, 30, 24, 18, 12, 6, 0, -6, -12, -18, -24, -30,
-36, -42, -48, -54, -59, -65, -70, -75, -80, -85, -89, -94, -98, -102, -105, -108, -112, -114, -117, -119, -121,
-123, -124, -125, -126, -126, -126, -126, -126, -125, -124, -123, -121, -119, -117, -114, -112, -108, -105, -102,
-98, -94, -89, -85, -80, -75, -70, -65, -59, -54, -48, -42, -36, -30, -24, -18, -12, -6 };
//放大128倍后的cos整数表(128)
code char COS_TAB[128] = { 127, 126, 126, 125, 124, 123, 121, 119, 117, 114, 112, 108, 105, 102, 98, 94,
89, 85, 80, 75, 70, 65, 59, 54, 48, 42, 36, 30, 24, 18, 12, 6, 0, -6, -12, -18, -24, -30, -36, -42, -48, -54, -59,
-65, -70, -75, -80, -85, -89, -94, -98, -102, -105, -108, -112, -114, -117, -119, -121, -123, -124, -125, -126, -
126, -126, -126, -126, -125, -124, -123, -121, -119, -117, -114, -112, -108, -105, -102, -98, -94, -89, -85, -80,
-75, -70, -65, -59, -54, -48, -42, -36, -30, -24, -18, -12, -6, 0, 6, 12, 18, 24, 30, 36, 42, 48, 54, 59, 65, 70,
75, 80, 85, 89, 94, 98, 102, 105, 108, 112, 114, 117, 119, 121, 123, 124, 125, 126, 126 };
//采样存储序列表
code char LIST_TAB[128] = { 0, 64, 32, 96, 16, 80, 48, 112,
8, 72, 40, 104, 24, 88, 56, 120,
4, 68, 36, 100, 20, 84, 52, 116,
12, 76, 44, 108, 28, 92, 60, 124,
2, 66, 34, 98, 18, 82, 50, 114,
10, 74, 42, 106, 26, 90, 58, 122,
6, 70, 38, 102, 22, 86, 54, 118,
14, 78, 46, 110, 30, 94, 62, 126,
1, 65, 33, 97, 17, 81, 49, 113,
9, 73, 41, 105, 25, 89, 57, 121,
5, 69, 37, 101, 21, 85, 53, 117,
13, 77, 45, 109, 29, 93, 61, 125,
3, 67, 35, 99, 19, 83, 51, 115,
11, 75, 43, 107, 27, 91, 59, 123,
7, 71, 39, 103, 23, 87, 55, 119,
15, 79, 47, 111, 31, 95, 63, 127
};
uchar COUNT=0,COUNT1=0,ADC_Count=0,LINE=15,G,T;
uchar i,j,k,b,p;
int Temp_Real,Temp_Imag,temp; // 中间临时变量
uint TEMP1;
int xdata Fft_Real[128];
int xdata Fft_Image[128]; // fft的虚部
uchar xdata LED_TAB2[64]; //记录 漂浮物 是否需要 停顿一下
uchar xdata LED_TAB[64]; //记录红色柱状
uchar xdata LED_TAB1[64]; //记录 漂浮点
void FFT()
{ //uchar X;
for( i=1; i<=7; i++) /* for(1) */
{
b=1;
b <<=(i-1); //碟式运算,用于计算 隔多少行计算 例如 第一极 1和2行计算,,第二级
for( j=0; j<=b-1; j++) /* for (2) */
{
p=1;
p <<= (7-i);
p = p*j;
for( k=j; k<128; k=k+2*b) /* for (3) 基二fft */
{
Temp_Real = Fft_Real[k]; Temp_Imag = Fft_Image[k]; temp = Fft_Real[k+b];
Fft_Real[k] = Fft_Real[k] + ((Fft_Real[k+b]*COS_TAB[p])>>7) + ((Fft_Image[k+b]*SIN_TAB[p])>>7);
Fft_Image[k] = Fft_Image[k] - ((Fft_Real[k+b]*SIN_TAB[p])>>7) + ((Fft_Image[k+b]*COS_TAB[p])>>7);
Fft_Real[k+b] = Temp_Real - ((Fft_Real[k+b]*COS_TAB[p])>>7) - ((Fft_Image[k+b]*SIN_TAB[p])>>7);
Fft_Image[k+b] = Temp_Imag + ((temp*SIN_TAB[p])>>7) - ((Fft_Image[k+b]*COS_TAB[p])>>7);
// 移位.防止溢出. 结果已经是本值的 1/64
Fft_Real[k] >>= 1;
Fft_Image[k] >>= 1;
Fft_Real[k+b] >>= 1;
Fft_Image[k+b] >>= 1;
}
}
}
Fft_Real[0]=Fft_Image[0]=0; //去掉直流分量
for(j=0;j<64;j++)
{
TEMP1=((((Fft_Real[j]* Fft_Real[j]))+((Fft_Image[j]*Fft_Image[j]))));//求功率
if(TEMP1<4)TEMP1=0;
else if(TEMP1<9)TEMP1=1;
else if(TEMP1<16)TEMP1=2;
else if(TEMP1<25)TEMP1=3;
else if(TEMP1<36)TEMP1=4;
else if(TEMP1<49)TEMP1=5;
else if(TEMP1<64)TEMP1=6;
else if(TEMP1<81)TEMP1=7;
else if(TEMP1<100)TEMP1=8;
else if(TEMP1<121)TEMP1=9;
else if(TEMP1<144)TEMP1=10;
else if(TEMP1<169)TEMP1=11;
else if(TEMP1<196)TEMP1=12;
else if(TEMP1<225)TEMP1=13;
else if(TEMP1<256)TEMP1=14;
else if(TEMP1<289)TEMP1=15;
else if(TEMP1<324)TEMP1=16;
else if(TEMP1<361)TEMP1=17;
else if(TEMP1<400)TEMP1=18;
else if(TEMP1<441)TEMP1=19;
else if(TEMP1<484)TEMP1=20;
else if(TEMP1<529)TEMP1=21;
else if(TEMP1<576)TEMP1=22;
else if(TEMP1<625)TEMP1=23 ;
else if(TEMP1<676)TEMP1=24;
else if(TEMP1<729)TEMP1=25;
else if(TEMP1<784)TEMP1=26;
else if(TEMP1<841)TEMP1=27;
else if(TEMP1<900)TEMP1=28;
else if(TEMP1<961)TEMP1=29;
else if(TEMP1<1024)TEMP1=30;
else TEMP1=31;
if(TEMP1>(LED_TAB[j]))LED_TAB[j]=TEMP1;
if(TEMP1>(LED_TAB1[j]))
{ LED_TAB1[j]=TEMP1;
LED_TAB2[j]=18; //提顿速度=12
}
}
}
void Init()
{
//-----------------------------------------------------------------------------------
P1ASF = 0x02; //0000,0010, 将 P1.1 置成模拟口
AUXR1 &=0xFB; //1111,1011, 令 ADRJ=0
EADC=1; //AD中断打开
ADC_CONTR = ADC_POWER | ADC_SPEEDHH | ADC_START | channel;
//-----------------------------------------------------------------------------------
P2M0=1;
P0M0=1;
TMOD=0X12;
TH0=0x83; //20k
TL0=0x83;
TH1=0xED;
TL1=0XC0;
ET0=1; //定时器0 打开
TR0=0; //关闭定时器
ET1=1;
TR1=1;
PT1=0;
PT0=1;
IPH=PADCH;
IP=PADC; //中断优先级
EA=1; //总中断打开
}
void ADC_Finish() interrupt 5
{ ADC_CONTR &= !ADC_FLAG;
Fft_Real[LIST_TAB[ADC_Count]]=(int)((ADC_RES)<<2)+(ADC_RESL)-512;//-512; //按LIST_TAB表里的顺序,进行存储 采样值,,
if(ADC_Count<=127)ADC_Count++;
else {EADC=0;TR0=0;}
}
void LED_Display() interrupt 3 //中断一次 显示一行。。。
{
TH1=0xF3;
TL1=0X00;
for (G=0;G<64;G++) //往点阵屏填充 一行的 数据
{
if(LED_TAB[G]<=LINE+16)SDA_R_TOP=1;
else SDA_R_TOP=0;
if(LED_TAB[G]<=LINE)SDA_R=1;
else SDA_R=0;
if(LED_TAB1[G]==LINE){SDA_G_TOP=1;SDA_G=0;}
else if(LED_TAB1[G]==(LINE+16)){SDA_G_TOP=0;SDA_G=1;}
else SDA_G=SDA_G_TOP=1;
SHCP=1;SHCP=0;
}
STCP=1;STCP=0;
P2=15-LINE;
if(LINE>0)LINE--;
else LINE=15;
if(LED_TAB[COUNT]>0)LED_TAB[COUNT]--;
COUNT++;
if(COUNT>=64)COUNT=0;
if(LED_TAB[COUNT]>0)LED_TAB[COUNT]--;
COUNT++;
if(COUNT>=64)COUNT=0;
if(LED_TAB[COUNT]>0)LED_TAB[COUNT]--; //柱状递减,
COUNT++;
if(COUNT>=64)COUNT=0;
if(LED_TAB[COUNT]>0)LED_TAB[COUNT]--;
COUNT++;
if(COUNT>=64)COUNT=0;
if(LED_TAB[COUNT]>0)LED_TAB[COUNT]--;
COUNT++;
if(COUNT>=64)COUNT=0;
if(LED_TAB[COUNT]>0)LED_TAB[COUNT]--;
COUNT++;
if(COUNT>=64)COUNT=0;
//漂浮物递减
if(LED_TAB2[COUNT1]==0) //判断是否需要停顿
{
if(LED_TAB1[COUNT1]>LED_TAB[COUNT1])LED_TAB1[COUNT1]--;//大于柱状则递减(保持漂浮物在柱状之上)
}
else LED_TAB2[COUNT1]--;
COUNT1++;
if(LED_TAB2[COUNT1]==0)
{
if(LED_TAB1[COUNT1]>LED_TAB[COUNT1])LED_TAB1[COUNT1]--;
}
else LED_TAB2[COUNT1]--;
COUNT1++;
if(LED_TAB2[COUNT1]==0) //判断是否需要停顿
{
if(LED_TAB1[COUNT1]>LED_TAB[COUNT1])LED_TAB1[COUNT1]--;//大于柱状则递减(保持漂浮物在柱状之上)
}
else LED_TAB2[COUNT1]--;
COUNT1++;
if(LED_TAB2[COUNT1]==0)
{
if(LED_TAB1[COUNT1]>LED_TAB[COUNT1])LED_TAB1[COUNT1]--;
}
else LED_TAB2[COUNT1]--;
COUNT1++;
if(COUNT1>=64)COUNT1=0;
}
void Ad_Control() interrupt 1 //控制采样率
{
ADC_CONTR = ADC_POWER | ADC_SPEEDHH| ADC_START | channel; //开始AD采集
}
//==============================================================================================================
// ******************* main() *********************************
//===============================================================================================================
void main()
{
Init();
while(1)
{
ADC_Count=0;
TR0=1;
EADC=1; //开启定时器中断0,,开启ADC
while(ADC_Count<128);
FFT();
}
} |
|