超聲波流速測量系統(tǒng)研究技術(shù)報告-資料下載頁
2025-06-25 11:59本頁面
【正文】 ****************************************************************** 超聲波流量計DSP編程 作者：徐宋靜 時間：***********************************************************************/include include unsigned ioport port8003。 /* AD 采集端口 */void kfft(pr,pi,n,k,fr,fi,l,il)int n,k,l,il。double pr[],pi[],fr[],fi[]。{ int it,m,is,i,j,nv,l0。 double p,q,s,vr,vi,poddr,poddi。 for (it=0。 it=n1。 it++) { m=it。 is=0。 for (i=0。 i=k1。 i++) { j=m/2。 is=2*is+(m2*j)。 m=j。 } fr[it]=pr[is]。 fi[it]=pi[is]。 } pr[0]=。 pi[0]=。 p=(*n)。 pr[1]=cos(p)。 pi[1]=sin(p)。 if (l!=0) pi[1]=pi[1]。 for (i=2。 i=n1。 i++) { p=pr[i1]*pr[1]。 q=pi[i1]*pi[1]。 s=(pr[i1]+pi[i1])*(pr[1]+pi[1])。 pr[i]=pq。 pi[i]=spq。 } for (it=0。 it=n2。 it=it+2) { vr=fr[it]。 vi=fi[it]。 fr[it]=vr+fr[it+1]。 fi[it]=vi+fi[it+1]。 fr[it+1]=vrfr[it+1]。 fi[it+1]=vifi[it+1]。 } m=n/2。 nv=2。 for (l0=k2。 l0=0。 l0) { m=m/2。 nv=2*nv。 for (it=0。 it=(m1)*nv。 it=it+nv) for (j=0。 j=(nv/2)1。 j++) { p=pr[m*j]*fr[it+j+nv/2]。 q=pi[m*j]*fi[it+j+nv/2]。 s=pr[m*j]+pi[m*j]。 s=s*(fr[it+j+nv/2]+fi[it+j+nv/2])。 poddr=pq。 poddi=spq。 fr[it+j+nv/2]=fr[it+j]poddr。 fi[it+j+nv/2]=fi[it+j]poddi。 fr[it+j]=fr[it+j]+poddr。 fi[it+j]=fi[it+j]+poddi。 } } if (l!=0) for (i=0。 i=n1。 i++) { fr[i]=fr[i]/(*n)。 fi[i]=fi[i]/(*n)。 } if (il!=0) for (i=0。 i=n1。 i++) { pr[i]=sqrt(fr[i]*fr[i]+fi[i]*fi[i])。 if (fabs(fr[i])*fabs(fi[i])) { if ((fi[i]*fr[i])0) pi[i]=。 else pi[i]=。 } else pi[i]=atan(fi[i]/fr[i])*。 }}void main(void){ int i,n,k=0。 double x[128],pr[128],pi[128],fr[128],fi[128],mo[128]。 int xm,zm。 int *px = (int*)0x4000。 int *pz = (int*)0x4080。 n=128 for (。) { px = (int*)0x4000。 /* 在這里采集數(shù)據(jù)到0x4000 */ if 0 for( i = 0。 i 128。 i++) { *px++ = port8003。 } endif px = (int*)0x4000。 for (i=0。 i=n1。 i++) { xm=*px。 x[i]=xm/。 pr[i]=x[i]。 pi[i]=0。 px++。 } kfft(pr,pi,128,7,fr,fi,0,1)。 pz = (int*)0x4080。 for (i=0。i=n1。i++) { mo[i] = sqrt(fr[i]*fr[i]+fi[i]*fi[i])。 zm = (int)(mo[i]*)。 *pz = zm。 pz++。 } k++。 }部分實物圖：超聲波傳感器CPLD試驗系統(tǒng)電路圖
公司管理相關(guān)推薦
鄂ICP備17016276號-1