wavefront0.c

超声波成像算法

/*                     WaveFront                             */
/*      埵抲p_vect偐傜偺斀幩攇偺廃攇悢惉暘傪寁嶼偡傞         */
/*      傾儗僀梫慺偼柍巜岦惈偲偡傞                           */
#include <math.h> 
#include "Reconst.h"
#include "GuoShuqiang.h"


/*	堷悢丗
/*		AINF array	丗傾儗僀偵娭偡傞僨乕僞
/*		int n_time	丗帪娫僒儞僾儖悢
/*		int n_band	丗廃攇悢僒儞僾儖悢
/*		int i_delay	丗A/D曄姺偺抶傟帪娫乮僒儞僾儖悢乯
/*		double h[]	: 嶌嬈梡攝楍乮悺朄n_time*4乯
/*			僄僐乕攇宍偺僼乕儕僄惉暘偑寁嶼偝傟偰栠傞
/*			  		h[0]乣h[n_band-1]偵幚悢晹
/*					h[n_time]乣h[n_time+n_band-1]偵嫊悢晹
/*		COMPLEX16 u_f[i][j]丗i斣栚偺憲怣攇宍偺戞j僼乕儕僄惉暘
/*		PVect p		丗埵抲儀僋僩儖
/************************************************************/
void WaveFront0(AINF array,int n_time,int n_band,int i_delay,
	int i_shot, COMPLEX16 **u_f, PVect p, double *h)
{
	int		i_time,i_freq, f_bias;
	double *h1_real,*h1_imag,*h2_real,*h2_imag;
	double	Ktx, Kty, Ktz,
		    dtr,tau_bias,
		    phase, apodi,
			buf1=0;
	double  L=0,Lmax=0,amp1=1,amp2=1,noise=0;
	int		row,
			k,n;
	double	tau;
	double dtheta,cos_th,sin_th;
	double low=10.0;
	dtheta    =	2*M_PI/(double)n_time;
	tau_bias=(double)(i_delay)/2.0;

	h1_real=h;
	h1_imag=h+  n_time;
	h2_real=h+2*n_time;
	h2_imag=h+3*n_time;

	f_bias=0;

	for(i_time=0;i_time<n_time;i_time++){
		h1_real[i_time]=0.0;
		h1_imag[i_time]=0.0;
	}
	/* 僩儔儞僗儈僢僞偺屄悢偩偗儖乕僾 */
	array.txp=array.tx; 
	array.typ=array.ty;
	for ( k=0; k<array.tnum; k++ )
	//for ( k=0; k<0; k++ )
	{//憲怣巕偵娭偡傞儖乕僾
		Ktx = p.x - (*array.txp);
		Kty = p.y - (*array.typ);
		Ktz = p.z ;
		dtr = DIST( Ktx, Kty, Ktz);//僩儔儞僗儈僢僞偐傜僞乕僎僢僩傑偱偺嫍棧傪寁嶼
		//僩儔儞僗儈僢僞乣僞乕僎僢僩乣儗僔乕僶傑偱
		//偺嫍棧乮僨傿儗僀乯傪僒儞僾儖悢偱惓婯壔偟偰寁嶼
		tau = dtheta*(dtr*SPRATE - tau_bias); 
		
		//巜岦惈寁嶼梡僼傽僋僞偺扨埵廃攇悢偁偨傝憹暘
		//  廃攇悢儖乕僾撪偺寁嶼傪壛嶼偵偟偰崅懍壔偟偰偄傞
		row = i_shot^k ;	/* 憲怣攇宍偵忔偢傞傾僟儅乕儖峴楍偺峴傪媮傔傞*/
		apodi = 1;//廳傒寁嶼
		n=0;

		/*******************妔********************/

		//if(row==0)
		//{
		//	//TwoDimensionArrayOutput(u_f,row,n_band);
		//	OneDimensionArrayOutput(h1_real,n_band);
		//}
		/*******************妔********************/

		for(i_freq=0;i_freq<n_band;i_freq++){
		//phase=dtheta*tau*(double)i_freq;
			phase=tau*(double)i_freq;
			phase=fmod(phase,2*M_PI);
			cos_th=cos(phase);
			sin_th=sin(phase);
			h1_real[i_freq]+=(u_f[row][i_freq].real*cos_th
							 +u_f[row][i_freq].imag*sin_th);
			h1_imag[i_freq]+=(-u_f[row][i_freq].real*sin_th
							 +u_f[row][i_freq].imag*cos_th);
		}

		array.txp++;
		array.typ++;
	}//k(transmitter)-loop
	return;
}