我做的项目是用激振锤锤击悬臂梁，DSP采集激振锤返回的力信号的电压值和安装在悬臂梁上的加速度传感器返回的加速度信号的电压值，将这两路信号做频响函数，但不知道这个程序能不能应用，各位大神有空的帮忙看看哈，万分感谢。我采样频率设置的是6K，采样点数是512个点。
程序如下：
#include <stdio.h>
#include <stdlib.h>
#include <math.h>
#include "msp.h"
void miirres(float a[],float b[],int lb,int la,complex h[],int n)
{
/*---------------------------------------------------------------------
Routinue miirres:to obtain the frequence responce (Amplitude and phase)
H(exp(jw)) of system function H(z)=B(z)/A(z);
b(0)+b(1)z^(-1)+ ... + b(lb)z^(-lb)
H(z)=------------------------------------
1.0 +a(1)z^(-1)+ ... + a(la)z^(-la)
input parameters:
a :la+1 dimensioned real array. a(0)=1.0,
a(n) (n=1 to la) is the coef. of z^(-n).
b :lb+1 dimensioned real array. b(n) (n=0 to la) is the coef. of z^(-n).
n :data point number of frequency response from 0.0 to pi.the frequency
resolution is pi/n.
output parameters:
H :n dimensioned complex array. frequency response is stored in
H(0) to H(n-1), which is normalized from 0.0 to pi.
Note: If H(k)=0/0,then let H(K)=H(k+1) (This is for the case of that
H(exp(jw)) is a sinc function)
: If la=0: for FIR system.
in Chapter 2
---------------------------------------------------------------------*/
complex z,bsum,asum;
int k,i;
int isign;
float pole,peak,pi,s,sf,sa,sb,temp;
pole=1.e-10;
peak=1.e+10;
pi=4.*atan(1.);
s=pi/(float)(n);
isign=0;
for(k=0;k<n;k++)
{
sf=s*k;
bsum.real=b[0];bsum.imag=0.0;
if(lb>0)
for(i=1;i<=lb;i++)
{
sb=sf*i;
z.real=cos(sb);z.imag=-sin(sb);
bsum.real+=b*z.real;
bsum.imag+=b*z.imag;
}
asum.real=1.;
asum.imag=0.0;
if(la!=0)
for(i=1;i<=la;i++)
{
sa=sf*i;
z.real=cos(sa);z.imag=-sin(sa);
asum.real+=a*z.real;
asum.imag+=a*z.imag;
}
if(mabs(asum)<pole)
{
if(mabs(bsum)<pole)
isign=1;
else
{
h[k].real=peak;
h[k].imag=0.0;
}
}
else
{
temp=pow(mabs(asum),2.0);
h[k].real=(bsum.real*asum.real+bsum.imag*asum.imag)/temp;
h[k].imag=(bsum.imag*asum.real-bsum.real*asum.imag)/temp;
if(isign==1)
{
h[k-1]=h[k];
isign=0;
}
}
}
return;
}
|
楼主
标题置顶
标题高亮
