/* sign function as defined in http://www.netlib.org/lapack/lawnspdf/lawn148.pdf */
static vsip_scalar_f sign_f(vsip_scalar_f a_in)
{
if(a_in < 0.0)
return -1.0;
else
return 1.0;
} /* same */
static void biDiagPhaseToZero_f( svdObj_f *svd)
{
vsip_mview_f *L = svd->L;
vsip_vview_f *d = svd->d;
vsip_vview_f *f = svd->f;
vsip_mview_f *R = svd->R;
vsip_scalar_f eps0 = svd->eps0;
vsip_length n_d=vsip_vgetlength_f(d);
vsip_length n_f=vsip_vgetlength_f(f);
vsip_index i,j;
vsip_scalar_f ps;
vsip_scalar_f m;
vsip_vview_f *l = svd->ls_one;
vsip_vview_f *r = svd->rs_one;
for(i=0; i<n_d; i++){
ps=vsip_vget_f(d,i);
m = vsip_mag_f(ps);
ps=sign_f(ps);
if(m > eps0){
col_sv_f(L,l,i);vsip_svmul_f(ps,l,l);
vsip_vput_f(d,i,m);
if (i < n_f)
vsip_vput_f(f,i,ps*vsip_vget_f(f,i));
} else {
vsip_vput_f(d,i,0.0);
}
}
svdZeroCheckAndSet_f(eps0,d,f);
for (i=0; i<n_f-1; i++){
j=i+1;
ps = vsip_vget_f(f,i);
m = vsip_mag_f(ps);
ps=sign_f(ps);
col_sv_f(L, l, j);vsip_svmul_f(ps,l,l);
row_sv_f(R,r,j);vsip_svmul_f(ps,r,r);
vsip_vput_f(f,i,m);
vsip_vput_f(f,j,ps * vsip_vget_f(f,j));
}
j=n_f;
i=j-1;
ps=vsip_vget_f(f,i);
m=vsip_mag_f(ps);
ps=sign_f(ps);
vsip_vput_f(f,i,m);
col_sv_f(L, l, j);vsip_svmul_f(ps,l,l);
row_sv_f(R,r,j);vsip_svmul_f(ps,r,r);
}
static void phaseCheck_f(svdObj_f *svd)
{
biDiagPhaseToZero_f(svd);
}
void houseProd_f(vsip_vview_f *v, vsip_mview_f *A)
{
vsip_mattr_f a_atr;
vsip_vview_f *w;
vsip_mview_f *B;
vsip_mgetattrib_f(A,&a_atr);
B=vsip_mcreate_f(a_atr.col_length,a_atr.row_length,VSIP_ROW,VSIP_MEM_NONE);
w = vsip_vcreate_f(a_atr.row_length,VSIP_MEM_NONE);
vsip_scalar_f beta = 2.0/vsip_vdot_f(v,v);
vsip_vmprod_f(v,A,w);
vsip_vouter_f(beta,v,w,B);
vsip_msub_f(A,B,A);
vsip_valldestroy_f(w);
vsip_malldestroy_f(B);
} /* need to remove create */
void prodHouse_f(vsip_mview_f *A, vsip_vview_f *v)
{
vsip_mattr_f a_atr;
vsip_vview_f *w;
vsip_mview_f *B;
vsip_mgetattrib_f(A,&a_atr);
B=vsip_mcreate_f(a_atr.col_length,a_atr.row_length,VSIP_ROW,VSIP_MEM_NONE);
w = vsip_vcreate_f(a_atr.col_length,VSIP_MEM_NONE);
vsip_scalar_f beta = 2.0/vsip_vdot_f(v,v);
vsip_mvprod_f(A,v,w);
vsip_vouter_f(beta,w,v,B);
vsip_msub_f(A,B,A);
vsip_valldestroy_f(w);
vsip_malldestroy_f(B);
} /* need to remove create */
int main(){vsip_init((void*)0);
{
int i,j;
vsip_vview_f* a = vsip_vcreate_f(M,0);
vsip_vview_f* b = vsip_vcreate_f(N,0);
vsip_mview_f* r = vsip_mcreate_f(
vsip_vgetlength_f(a),
vsip_vgetlength_f(b),
VSIP_ROW,0);
vsip_vramp_f(1.0, 1.0 , b);
vsip_vramp_f(1.0, -2.0/(double)(N-1), a);
vsip_vouter_f(1,a, b, r);
printf("a = [\n");
for(i=0; i<vsip_vgetlength_f(a); i++)
printf("%6.3f%s\n", vsip_vget_f(a,i),
(i == vsip_vgetlength_f(a) -1) ? "":";");
printf("]\n");
printf("b = [\n");
for(i=0; i<vsip_vgetlength_f(b); i++)
printf("%6.3f%s\n", vsip_vget_f(b,i),
(i == vsip_vgetlength_f(a) -1) ? "":";");
printf("]\n");
printf("\na * b' = \n");
for(i=0; i<vsip_vgetlength_f(a); i++){
for(j=0; j<vsip_vgetlength_f(b); j++)
printf("%6.3f ",vsip_mget_f(r,i,j));
printf("\n");
}
printf("]\n");
/*destroy the vector views and any associated blocks*/
vsip_valldestroy_f(b);
vsip_valldestroy_f(a);
vsip_malldestroy_f(r);
} vsip_finalize((void*)0); return 0;
}
int main(){vsip_init((void*)0);
{ int i,j; /* counters */
vsip_vview_f *windowt = vsip_vcreate_hanning_f(Ns,0);
vsip_vview_f *windowp = vsip_vcreate_hanning_f(Mp,0);
vsip_vview_f *kernel =
vsip_vcreate_kaiser_f(Nfilter,kaiser,0);
vsip_fir_f *fir = vsip_fir_create_f(kernel,
VSIP_NONSYM,2 * Nn,2,VSIP_STATE_SAVE,0,0);
vsip_vview_f *t =vsip_vcreate_f(Ns,0); /*time vector*/
vsip_vview_f *noise[Nnoise];
vsip_vview_f *nv = vsip_vcreate_f(2 * Nn,0);
vsip_vview_f *tt = vsip_vcreate_f(Ns,0);
vsip_mview_f *data = vsip_mcreate_f(Mp,Ns,VSIP_ROW,0),
*rmview;
vsip_vview_f *data_v, *gram_v;
vsip_cvview_f *gram_data_v;
vsip_cmview_f *gram_data =
vsip_cmcreate_f(Mp,Ns/2 + 1,VSIP_COL,0);
vsip_mview_f *gram =
vsip_mcreate_f(Mp,Ns/2 + 1,VSIP_ROW,0);
vsip_mview_f *Xim =
vsip_mcreate_f(Mp,Mp+1,VSIP_ROW,0);
vsip_scalar_f alpha = (D * Fs) / c;
vsip_vview_f *m = vsip_vcreate_f(Mp,0);
vsip_vview_f *Xi = vsip_vcreate_f(Mp + 1,0);
vsip_randstate *state =
vsip_randcreate(15,1,1,VSIP_PRNG);
vsip_scalar_f w0 = 2 * M_PI * F0/Fs;
vsip_scalar_f w1 = 2 * M_PI * F1/Fs;
vsip_scalar_f w2 = 2 * M_PI * F2/Fs;
vsip_scalar_f w3 = 2 * M_PI * F3/Fs;
vsip_scalar_f cnst1 = M_PI/Nnoise;
vsip_offset offset0 = (vsip_offset)(alpha * Mp + 1);
vsip_fftm_f *rcfftmop_obj = /* time fft */
vsip_rcfftmop_create_f(Mp,Ns,1,VSIP_ROW,0,0);
vsip_fftm_f *ccfftmip_obj =
vsip_ccfftmip_create_f(Mp,Ns/2 +
1,VSIP_FFT_FWD,1,VSIP_COL,0,0);
vsip_vramp_f(0,1,m);
vsip_vramp_f(0,M_PI/Mp,Xi);
vsip_vcos_f(Xi,Xi);
vsip_vouter_f(alpha,m,Xi,Xim);
{ vsip_vview_f *gram_v = vsip_mrowview_f(gram,0);
vsip_vputlength_f(gram_v,Mp*(Ns/2 + 1));
vsip_vfill_f(0,gram_v);
vsip_vdestroy_f(gram_v);
}
for(j=0; j<Nnoise; j++){
noise[j] = vsip_vcreate_f(Nn,0);
vsip_vrandn_f(state,nv);
vsip_firflt_f(fir,nv,noise[j]);
vsip_svmul_f(12.0/(Nnoise),noise[j],noise[j]);
vsip_vputlength_f(noise[j],Ns);
}
vsip_vramp_f(0,1.0,t); /* time vector */
for(i=0; i<Mp; i++){
vsip_scalar_f Xim_val = vsip_mget_f(Xim,i,Theta_o);
data_v = vsip_mrowview_f(data,i);
vsip_vsmsa_f(t,w0,-w0 * Xim_val,tt);
vsip_vcos_f(tt,data_v); /*F0 time series */
vsip_vsmsa_f(t,w1,-w1 * Xim_val,tt);
vsip_vcos_f(tt,tt); /*F1 time series */
vsip_vadd_f(tt,data_v,data_v);
vsip_vsmsa_f(t,w2,-w2 * Xim_val,tt);
vsip_vcos_f(tt,tt); /*F2 time series */
vsip_vadd_f(tt,data_v,data_v);
vsip_vsmsa_f(t,w3,-w3 * Xim_val,tt);
vsip_vcos_f(tt,tt); /*F3 time series */
vsip_svmul_f(3.0,tt,tt); /* scale by 3.0 */
vsip_vadd_f(tt,data_v,data_v);
vsip_svmul_f(3,data_v,data_v);
for(j=0; j<Nnoise; j++){
/* simple time delay beam forming for noise */
vsip_vputoffset_f(noise[j],offset0 +
(int)( i * alpha * cos(j * cnst1)));
vsip_vadd_f(noise[j],data_v,data_v);
}
/* need to destroy before going on to next phone */
vsip_vdestroy_f(data_v);
}
/* window the data and the array to reduce sidelobes */
vsip_vmmul_f(windowt,data,VSIP_ROW,data);
vsip_vmmul_f(windowp,data,VSIP_COL,data);
/* do ffts */
vsip_rcfftmop_f(rcfftmop_obj,data,gram_data);
vsip_ccfftmip_f(ccfftmip_obj,gram_data);
{ /* scale gram to db, min 0 max 255 */
vsip_index ind;
gram_v = vsip_mrowview_f(gram,0);
gram_data_v = vsip_cmcolview_f(gram_data,0);
rmview = vsip_mrealview_f(gram_data);
vsip_vputlength_f(gram_v,Mp*(Ns/2 + 1));
vsip_cvputlength_f(gram_data_v,Mp*(Ns/2 + 1));
data_v = vsip_vrealview_f(gram_data_v);
vsip_vcmagsq_f(gram_data_v,data_v);
vsip_mcopy_f_f(rmview,gram);
vsip_vdestroy_f(data_v);
vsip_svadd_f(1.0 -
vsip_vminval_f(gram_v,&ind),gram_v,gram_v);
vsip_vlog10_f(gram_v,gram_v);
vsip_svmul_f(256.0 / vsip_vmaxval_f(gram_v,&ind),
gram_v,gram_v);/* scale */
/* reorganize the data to place zero in the
center for direction space */
data_v = vsip_vcloneview_f(gram_v);
vsip_vputlength_f(data_v,(Mp/2) * (Ns/2 + 1));
vsip_vputoffset_f(data_v,(Mp/2) * (Ns/2 + 1));
vsip_vputlength_f(gram_v,(Mp/2) * (Ns/2 + 1));
vsip_vswap_f(data_v,gram_v);
vsip_vdestroy_f(gram_v);
vsip_vdestroy_f(data_v);
vsip_cvdestroy_f(gram_data_v);
vsip_mdestroy_f(rmview);
}
VU_mprintgram_f(gram,"gram_output");
} vsip_finalize((void*)0); return 0;
}
