CODmarker_param_t get_CODmkrdata_from_j2kstream( Byte_t *CODstream)
{
CODmarker_param_t COD;
int i;
if( *CODstream++ != 0xff || *CODstream++ != 0x52){
fprintf( FCGI_stderr, "Error, COD marker not found in the reconstructed j2kstream\n");
return COD;
}
COD.Lcod = big2( CODstream);
COD.Scod = *( CODstream+2);
COD.prog_order = *( CODstream+3);
COD.numOflayers = big2( CODstream+4);
COD.numOfdecomp = *( CODstream+7);
if(COD.Scod & 0x01){
COD.XPsiz = (Byte4_t *)malloc( (COD.numOfdecomp+1)*sizeof(Byte4_t));
COD.YPsiz = (Byte4_t *)malloc( (COD.numOfdecomp+1)*sizeof(Byte4_t));
for( i=0; i<=COD.numOfdecomp; i++){
//precinct size
COD.XPsiz[i] = pow( 2, *( CODstream+12+i) & 0x0F);
COD.YPsiz[i] = pow( 2, (*( CODstream+12+i) & 0xF0) >> 4);
}
}
SIZmarker_param_t get_SIZmkrdata_from_j2kstream( Byte_t *SIZstream)
{
SIZmarker_param_t SIZ ={0};
int i;
if( *SIZstream++ != 0xff || *SIZstream++ != 0x51){
fprintf( FCGI_stderr, "Error, SIZ marker not found in the reconstructed j2kstream\n");
return SIZ;
}
SIZ.Lsiz = big2( SIZstream);
SIZ.Rsiz = big2( SIZstream+2);
SIZ.Xsiz = big4( SIZstream+4);
SIZ.Ysiz = big4( SIZstream+8);
SIZ.XOsiz = big4( SIZstream+12);
SIZ.YOsiz = big4( SIZstream+16);
SIZ.XTsiz = big4( SIZstream+20);
SIZ.YTsiz = big4( SIZstream+24);
SIZ.XTOsiz = big4( SIZstream+28);
SIZ.YTOsiz = big4( SIZstream+32);
SIZ.Csiz = big2( SIZstream+36);
SIZ.XTnum = ( SIZ.Xsiz-SIZ.XTOsiz+SIZ.XTsiz-1)/SIZ.XTsiz;
SIZ.YTnum = ( SIZ.Ysiz-SIZ.YTOsiz+SIZ.YTsiz-1)/SIZ.YTsiz;
for( i=0; i<(int)SIZ.Csiz; i++){
SIZ.Ssiz[i] = *(SIZstream+(38+i*3));
SIZ.XRsiz[i] = *(SIZstream+(39+i*3));
SIZ.YRsiz[i] = *(SIZstream+(40+i*3));
}
return SIZ;
}
//------------------------------------------------------------------------------------
int fdct3d_inverse_center(int N1,int N2,int N3,int b, double L1,double L2,double L3, int s,
CpxCrvletPrtd& C, CpxNumTnsBlkd& W)
{
int mpirank; MPI_Comm_rank(MPI_COMM_WORLD, &mpirank);
vector< vector<int> >& Cowners = C.owners();
if(Cowners[0][0]==mpirank) {
int S1, S2, S3; int F1, F2, F3; double R1, R2, R3; fdct3d_rangecompute(L1, L2, L3, S1, S2, S3, F1, F2, F3, R1, R2, R3);
DblOffVec big1(S1); fdct3d_lowpass(L1, big1);
DblOffVec big2(S2); fdct3d_lowpass(L2, big2);
DblOffVec big3(S3); fdct3d_lowpass(L3, big3);
CpxNumTns T(S1,S2,S3);
CpxNumTns& Cblk = C.block(0,0); //center block
T = Cblk;
fftwnd_plan p = fftw3d_create_plan(S3,S2,S1, FFTW_FORWARD, FFTW_ESTIMATE | FFTW_IN_PLACE);
fftwnd_one(p, (fftw_complex*)T.data(), NULL);
fftwnd_destroy_plan(p);
double sqrtprod = sqrt(double(S1*S2*S3));
for(int i=0; i<S1; i++) for(int j=0; j<S2; j++) for(int k=0; k<S3; k++) T(i,j,k) /= sqrtprod;
CpxOffTns A(S1,S2,S3);
fdct3d_fftshift(S1,S2,S3,T,A);
for(int i=-S1/2; i<-S1/2+S1; i++)
for(int j=-S2/2; j<-S2/2+S2; j++)
for(int k=-S3/2; k<-S3/2+S3; k++) {
int bi,bj,bk; int oi,oj,ok; fdct3d_position_aux(N1,N2,N3,b, i,j,k, bi,bj,bk,oi,oj,ok);
CpxNumTns& Wblk = W.block(bi,bj,bk);
Wblk(oi,oj,ok) += A(i,j,k) * (big1(i)*big2(j)*big3(k));
}
//done
}
return 0;
}
bool get_mainheader_from_j2kstream( Byte_t *j2kstream, SIZmarker_param_t *SIZ, CODmarker_param_t *COD)
{
if( *j2kstream++ != 0xff || *j2kstream++ != 0x4f){
fprintf( FCGI_stderr, "Error, j2kstream is not starting with SOC marker\n");
return false;
}
if( SIZ){
*SIZ = get_SIZmkrdata_from_j2kstream( j2kstream);
if( SIZ->Lsiz == 0)
return false;
j2kstream += (SIZ->Lsiz+2);
}
if( COD){
if( !SIZ)
j2kstream += (big2( j2kstream+2) + 2);
*COD = get_CODmkrdata_from_j2kstream( j2kstream);
if( COD->Lcod == 0)
return false;
}
return true;
}
void test_big_num()
{
BigNum<unsigned int> big1("56"); //567
BigNum<unsigned int> big2("4932");
//big1 += big2;
BigNum<unsigned int> big3 = big2*big1;
BigNum<unsigned int> big4("56");
printf("equal=%d\n",big1==big4);
printf("equal=%d\n",big1==big3);
int gh = 0;
}
Byte2_t fetch_2bytebigendian( int fd, OPJ_OFF_T offset)
{
Byte_t *data;
Byte2_t code;
if(!(data = fetch_bytes( fd, offset, 2))){
fprintf( FCGI_stderr, "Error: error in fetch_2bytebigendian( %d, %ld)\n", fd, offset);
return 0;
}
code = big2(data);
free( data);
return code;
}
ihdrbox_param_t * gene_ihdrbox( metadatalist_param_t *metadatalist, Byte_t *jpipstream)
{
ihdrbox_param_t *ihdrbox;
metadata_param_t *meta;
box_param_t *jp2h, *ihdr;
int bpc_val;
jp2h = NULL;
meta = metadatalist->first;
while( meta){
if( meta->boxlist){
jp2h = search_box( "jp2h", meta->boxlist);
if( jp2h)
break;
}
meta = meta->next;
}
if( !jp2h){
fprintf( stderr, "jp2h box not found\n");
return NULL;
}
ihdr = gene_boxbyTypeinStream( jpipstream, get_DBoxoff( jp2h), get_DBoxlen( jp2h), "ihdr");
if( !ihdr){
fprintf( stderr, "ihdr box not found\n");
return NULL;
}
ihdrbox = (ihdrbox_param_t *)malloc( sizeof(ihdrbox_param_t));
ihdrbox->height = big4( jpipstream+get_DBoxoff(ihdr));
ihdrbox->width = big4( jpipstream+get_DBoxoff(ihdr)+4);
ihdrbox->nc = big2( jpipstream+get_DBoxoff(ihdr)+8);
bpc_val = *(jpipstream+get_DBoxoff(ihdr)+10)+1;
assert( bpc_val >= 0 && bpc_val <= 255 );
ihdrbox->bpc = (Byte_t)bpc_val;
free( ihdr);
return ihdrbox;
}
//------------------------------------------------------------------------------------
int fdct3d_inverse(int N1, int N2, int N3, int nbscales, int nbdstz_coarse,
CpxCrvletPrtd& C, CpxNumTnsBlkd& W,
CpxNumTnsBlkd& X)
{
//check the size of c,w, make sure it is okay
time_t tm0, tm1; tm0 = time(NULL);
int b = W.b();
int e = W.e(); int f = W.f(); int g = W.g();
int mpirank; MPI_Comm_rank(MPI_COMM_WORLD, &mpirank);
iC( MPI_Barrier(MPI_COMM_WORLD) ); //iC( PetscPrintf(MPI_COMM_WORLD, "%d inverse 0\n", mpirank) ); iC( MPI_Barrier(MPI_COMM_WORLD) );
//-------------------------------------------
//1. fft on X
X = W;
BolNumTns newtnsexists(e,f,g);
IntNumTns newtnsowners(e,f,g);
fdct3d_partition_cpxnumtnsblkd_z(N1,N2,N3,b, newtnsexists,newtnsowners);
//scatter x to contain z slices
iC( X.scatter(newtnsexists) ); iC( MPI_Barrier(MPI_COMM_WORLD) ); tm1 = time(NULL); //iC( PetscPrintf(MPI_COMM_WORLD, "inv x scatter %f\n", difftime(tm1,tm0)) ); tm0 = tm1;
//shift x's owner to z slices
iC( X.shift(newtnsowners) ); iC( MPI_Barrier(MPI_COMM_WORLD) ); tm1 = time(NULL); //iC( PetscPrintf(MPI_COMM_WORLD, "inv x shift %f\n", difftime(tm1,tm0)) ); tm0 = tm1;
//discard x's nonowners
iC( X.discard() ); iC( MPI_Barrier(MPI_COMM_WORLD) ); tm1 = time(NULL); //iC( PetscPrintf(MPI_COMM_WORLD, "inv x discard %f\n", difftime(tm1,tm0)) ); tm0 = tm1;
//ifft
iC( fdct3d_fft(X) ); iC( MPI_Barrier(MPI_COMM_WORLD) ); tm1 = time(NULL); //iC( PetscPrintf(MPI_COMM_WORLD, "inv x fft %f\n", difftime(tm1,tm0)) ); tm0 = tm1;
//scale x with POU
DblOffVec big1(N1); fdct3d_lowpass(2.0*N1/3, big1);
DblOffVec big2(N2); fdct3d_lowpass(2.0*N2/3, big2);
DblOffVec big3(N3); fdct3d_lowpass(2.0*N3/3, big3);
IntNumTns& Xowners = X.owners();
for(int i=0; i<e; i++) for(int j=0; j<f; j++) for(int k=0; k<g; k++) {
if(Xowners(i,j,k)==mpirank) {
CpxNumTns& Xblk = X.block(i,j,k);
int istt = i*b-N1/2; int jstt = j*b-N2/2; int kstt = k*b-N3/2;
for(int ioff=0; ioff<b; ioff++) for(int joff=0; joff<b; joff++) for(int koff=0; koff<b; koff++) {
double pou = big1(ioff+istt) * big2(joff+jstt)*big3(koff+kstt);
Xblk(ioff, joff, koff) *= sqrt(1-pou*pou);
}
}
}
//-------------------------------------------
//2. compute wedges
int L = nbscales;
//setup c, 1,2,3, 6*np/8 processors are computing. 0 processor contains also the center wedge
vector< vector<bool> > newcrvexists;
vector< vector<int > > newcrvowners;
fdct3d_partition_cpxcrvletprtd(N1,N2,N3, nbscales, nbdstz_coarse, newcrvexists, newcrvowners);
//vector< vector<double> > fxs, fys, fzs;
//vector< vector<int > > nxs, nys, nzs;
//fdct3d_param(N1,N2,N3, nbscales,nbdstz_coarse, fxs,fys,fzs, nxs,nys,nzs); //LEXING: might not be necessary
//find out the required blocks from x for each processor
fdct3d_dependency(N1,N2,N3,b, nbscales,nbdstz_coarse, newcrvowners, newtnsexists);
//expand x according to c's request
iC( X.expand(newtnsexists) ); iC( MPI_Barrier(MPI_COMM_WORLD) ); tm1 = time(NULL); //iC( PetscPrintf(MPI_COMM_WORLD, "inv x expand %f\n", difftime(tm1,tm0)) ); tm0 = tm1;
//compute contribution to x from c
{
int s = 0;
double L1 = 2.0*N1/3.0 / pow2(L-2-s); double L2 = 2.0*N2/3.0 / pow2(L-2-s); double L3 = 2.0*N3/3.0 / pow2(L-2-s);
fdct3d_inverse_center(N1,N2,N3,b, L1,L2,L3, s, C, X);
}
for(int s=1; s<nbscales-1; s++) {
double L1 = 2.0*N1/3.0 / pow2(L-2-s); double L2 = 2.0*N2/3.0 / pow2(L-2-s); double L3 = 2.0*N3/3.0 / pow2(L-2-s);
int nd = nbdstz_coarse * pow2(s/2);
fdct3d_inverse_angles(N1,N2,N3,b, L1,L2,L3, s, nd, C, X);
}
iC( MPI_Barrier(MPI_COMM_WORLD) ); tm1 = time(NULL); //iC( PetscPrintf(MPI_COMM_WORLD, "inv c compute %f\n", difftime(tm1,tm0)) ); tm0 = tm1;
//combine x
iC( X.combine() ); iC( MPI_Barrier(MPI_COMM_WORLD) ); tm1 = time(NULL); //iC( PetscPrintf(MPI_COMM_WORLD, "inv x combine %f\n", difftime(tm1,tm0)) ); tm0 = tm1;
//-------------------------------------------
//3. ifft on X
iC( fdct3d_ifft(X) ); iC( MPI_Barrier(MPI_COMM_WORLD) ); tm1 = time(NULL); //iC( PetscPrintf(MPI_COMM_WORLD, "inv x ifft %f\n", difftime(tm1,tm0)) ); tm0 = tm1;
//done
return 0;
}
//------------------------------------------------------------------------------------
int fdct3d_inverse_angles(int N1,int N2,int N3,int b, double L1,double L2,double L3, int s,int nd,
CpxCrvletPrtd& C, CpxNumTnsBlkd& W)
{
int mpirank; MPI_Comm_rank(MPI_COMM_WORLD, &mpirank);
int mpisize; MPI_Comm_size(MPI_COMM_WORLD, &mpisize);
vector< vector<int> >& Cowners = C.owners();
vector<int>& crvowners = Cowners[s]; //LEXING: the owner information for wedges in scale s
int nf = 6;
int wcnt = 0;
int S1, S2, S3; int F1, F2, F3; double R1, R2, R3; fdct3d_rangecompute(L1, L2, L3, S1, S2, S3, F1, F2, F3, R1, R2, R3);
DblOffVec big1(S1); fdct3d_lowpass(L1, big1);
DblOffVec big2(S2); fdct3d_lowpass(L2, big2);
DblOffVec big3(S3); fdct3d_lowpass(L3, big3);
double Lh1 = L1/2; double Lh2 = L2/2; double Lh3 = L3/2;
int Sh1, Sh2, Sh3; int Fh1, Fh2, Fh3; double Rh1, Rh2, Rh3; fdct3d_rangecompute(Lh1, Lh2, Lh3, Sh1, Sh2, Sh3, Fh1, Fh2, Fh3, Rh1, Rh2, Rh3);
DblOffVec sma1(S1); fdct3d_lowpass(Lh1, sma1);
DblOffVec sma2(S2); fdct3d_lowpass(Lh2, sma2);
DblOffVec sma3(S3); fdct3d_lowpass(Lh3, sma3);
double W1 = L1/nd; double W2 = L2/nd; double W3 = L3/nd;
typedef pair<int,int> intpair; typedef pair<int, intpair> inttriple;
map<inttriple, fftwnd_plan> planmap;
//face 0: x,y,z
for(int h=0; h<nd; h++) { //(y first z second)
for(int g=0; g<nd; g++) {
if(crvowners[wcnt]==mpirank) {
double xs = R1/4-(W1/2)/4; double xe = R1;
double ys = -R2 + (2*g-1)*W2/2; double ye = -R2 + (2*g+3)*W2/2;
double zs = -R3 + (2*h-1)*W3/2; double ze = -R3 + (2*h+3)*W3/2;
int xn = int(ceil(xe-xs)); int yn = int(ceil(ye-ys)); int zn = int(ceil(ze-zs));
double thts, thtm, thte; //y to x
if(g==0) {
thts = atan2(-1.0, 1.0-1.0/nd); thtm = atan2(-1.0+1.0/nd, 1.0); thte = atan2(-1.0+3.0/nd, 1.0);
} else if(g==nd-1) {
thts = atan2(-1.0+(2.0*g-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*g+1.0)/nd, 1.0); thte = atan2(1.0, 1.0-1.0/nd);
} else {
thts = atan2(-1.0+(2.0*g-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*g+1.0)/nd, 1.0); thte = atan2(-1.0+(2.0*g+3.0)/nd, 1.0);
}
double phis, phim, phie; //z to x
if(h==0) {
phis = atan2(-1.0, 1.0-1.0/nd); phim = atan2(-1.0+1.0/nd, 1.0); phie = atan2(-1.0+3.0/nd, 1.0);
} else if(h==nd-1) {
phis = atan2(-1.0+(2.0*h-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*h+1.0)/nd, 1.0); phie = atan2(1.0, 1.0-1.0/nd);
} else {
phis = atan2(-1.0+(2.0*h-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*h+1.0)/nd, 1.0); phie = atan2(-1.0+(2.0*h+3.0)/nd, 1.0);
}
int xh = xn/2; int yh = yn/2; int zh = zn/2; //half
double R21 = R2/R1; double R31 = R3/R1;
CpxNumTns tpdata(xn,yn,zn);
CpxNumTns& Cblk = C.block(s,wcnt);
tpdata = Cblk;
//fft
fftwnd_plan p = NULL;
map<inttriple, fftwnd_plan>::iterator mit = planmap.find( inttriple(xn, intpair(yn,zn)) );
if(mit!=planmap.end()) { p = (*mit).second;
} else {
p = fftw3d_create_plan(zn, yn, xn, FFTW_FORWARD, FFTW_ESTIMATE | FFTW_IN_PLACE);
planmap[ inttriple(xn, intpair(yn,zn)) ] = p;
}
fftwnd_one(p, (fftw_complex*)tpdata.data(), NULL); //cerr<<"wedge s"<<endl;
double sqrtprod = sqrt(double(xn*yn*zn));
for(int i=0; i<xn; i++) for(int j=0; j<yn; j++) for(int k=0; k<zn; k++) tpdata(i,j,k) /= sqrtprod;
CpxOffTns wpdata(xn,yn,zn);
fdct3d_fftshift(xn,yn,zn,tpdata,wpdata);
for(int xcur=(int)ceil(xs); xcur<xe; xcur++) {
int yfm = (int)ceil( max(-R2, R21*xcur*tan(thts)) );
int yto = (int)floor( min(R2, R21*xcur*tan(thte)) );
int zfm = (int)ceil( max(-R3, R31*xcur*tan(phis)) );
int zto = (int)floor( min(R3, R31*xcur*tan(phie)) );
for(int ycur=yfm; ycur<=yto; ycur++)
for(int zcur=zfm; zcur<=zto; zcur++) {
int tmpx = xcur%xn; if(tmpx<-xh) tmpx+=xn; if(tmpx>=-xh+xn) tmpx-=xn;
int tmpy = ycur%yn; if(tmpy<-yh) tmpy+=yn; if(tmpy>=-yh+yn) tmpy-=yn;
int tmpz = zcur%zn; if(tmpz<-zh) tmpz+=zn; if(tmpz>=-zh+zn) tmpz-=zn;
double thtcur = atan2(ycur/R2, xcur/R1);
double phicur = atan2(zcur/R3, xcur/R1);
double glbpou; fdct3d_globalpou(thtcur, phicur, M_PI/4-atan2(1.0-1.0/nd, 1.0), glbpou);
double wtht;
if(thtcur<thtm) {
if(g==0) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thts)/(thtm-thts), l, r); wtht = l; }
} else {
if(g==nd-1) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thtm)/(thte-thtm), l, r); wtht = r; }
}
double wphi;
if(phicur<phim) {
if(h==0) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phis)/(phim-phis), l, r); wphi = l; }
} else {
if(h==nd-1) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phim)/(phie-phim), l, r); wphi = r; }
}
double pou = glbpou * wtht * wphi;
wpdata(tmpx, tmpy, tmpz) *= pou;
double ss = sma1(xcur)*sma2(ycur)*sma3(zcur); double bb = big1(xcur)*big2(ycur)*big3(zcur);
int bi,bj,bk; int oi,oj,ok; fdct3d_position_aux(N1,N2,N3,b, xcur,ycur,zcur, bi,bj,bk,oi,oj,ok);
CpxNumTns& Wblk = W.block(bi,bj,bk);
Wblk(oi,oj,ok) += wpdata(tmpx,tmpy,tmpz) * bb * sqrt(1.0-ss*ss);
}
} //xcur
} //if
wcnt++;
}
} //end of face
//face 1. y z x
for(int f=0; f<nd; f++) {
for(int h=0; h<nd; h++) {
if(crvowners[wcnt]==mpirank) {
double ys = R2/4-(W2/2)/4; double ye = R2;
double zs = -R3 + (2*h-1)*W3/2; double ze = -R3 + (2*h+3)*W3/2;
double xs = -R1 + (2*f-1)*W1/2; double xe = -R1 + (2*f+3)*W1/2;
int xn = int(ceil(xe-xs)); int yn = int(ceil(ye-ys)); int zn = int(ceil(ze-zs));
double thts, thtm, thte; //z to y
if(h==0) {
thts = atan2(-1.0, 1.0-1.0/nd); thtm = atan2(-1.0+1.0/nd, 1.0); thte = atan2(-1.0+3.0/nd, 1.0);
} else if(h==nd-1) {
thts = atan2(-1.0+(2.0*h-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*h+1.0)/nd, 1.0); thte = atan2(1.0, 1.0-1.0/nd);
} else {
thts = atan2(-1.0+(2.0*h-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*h+1.0)/nd, 1.0); thte = atan2(-1.0+(2.0*h+3.0)/nd, 1.0);
}
double phis, phim, phie; //z to x
if(f==0) {
phis = atan2(-1.0, 1.0-1.0/nd); phim = atan2(-1.0+1.0/nd, 1.0); phie = atan2(-1.0+3.0/nd, 1.0);
} else if(f==nd-1) {
phis = atan2(-1.0+(2.0*f-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*f+1.0)/nd, 1.0); phie = atan2(1.0, 1.0-1.0/nd);
} else {
phis = atan2(-1.0+(2.0*f-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*f+1.0)/nd, 1.0); phie = atan2(-1.0+(2.0*f+3.0)/nd, 1.0);
}
int xh = xn/2; int yh = yn/2; int zh = zn/2;
double R32 = R3/R2; double R12 = R1/R2;
CpxNumTns tpdata(xn,yn,zn);
CpxNumTns& Cblk = C.block(s,wcnt);
tpdata = Cblk;
//fft
fftwnd_plan p = NULL;
map<inttriple, fftwnd_plan>::iterator mit = planmap.find( inttriple(xn, intpair(yn,zn)) );
if(mit!=planmap.end()) { p = (*mit).second;
} else {
p = fftw3d_create_plan(zn, yn, xn, FFTW_FORWARD, FFTW_ESTIMATE | FFTW_IN_PLACE);
planmap[ inttriple(xn, intpair(yn,zn)) ] = p;
}
fftwnd_one(p, (fftw_complex*)tpdata.data(), NULL); //cerr<<"wedge s"<<endl;
double sqrtprod = sqrt(double(xn*yn*zn));
for(int i=0; i<xn; i++) for(int j=0; j<yn; j++) for(int k=0; k<zn; k++) tpdata(i,j,k) /= sqrtprod;
CpxOffTns wpdata(xn,yn,zn);
fdct3d_fftshift(xn,yn,zn,tpdata,wpdata);
for(int ycur=(int)ceil(ys); ycur<ye; ycur++) {
int zfm = (int)ceil( max(-R3, R32*ycur*tan(thts)) );
int zto = (int)floor( min(R3, R32*ycur*tan(thte)) );
int xfm = (int)ceil( max(-R1, R12*ycur*tan(phis)) );
int xto = (int)floor( min(R1, R12*ycur*tan(phie)) );
for(int zcur=zfm; zcur<=zto; zcur++)
for(int xcur=xfm; xcur<=xto; xcur++) {
int tmpx = xcur%xn; if(tmpx<-xh) tmpx+=xn; if(tmpx>=-xh+xn) tmpx-=xn;
int tmpy = ycur%yn; if(tmpy<-yh) tmpy+=yn; if(tmpy>=-yh+yn) tmpy-=yn;
int tmpz = zcur%zn; if(tmpz<-zh) tmpz+=zn; if(tmpz>=-zh+zn) tmpz-=zn;
double thtcur = atan2(zcur/R3, ycur/R2);
double phicur = atan2(xcur/R1, ycur/R2);
double glbpou; fdct3d_globalpou(thtcur, phicur, M_PI/4-atan2(1.0-1.0/nd, 1.0), glbpou); //CHECK
double wtht;
if(thtcur<thtm) {
if(h==0) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thts)/(thtm-thts), l, r); wtht = l; }
} else {
if(h==nd-1) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thtm)/(thte-thtm), l, r); wtht = r; }
}
double wphi;
if(phicur<phim) {
if(f==0) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phis)/(phim-phis), l, r); wphi = l; }
} else {
if(f==nd-1) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phim)/(phie-phim), l, r); wphi = r; }
}
double pou = glbpou * wtht * wphi;
wpdata(tmpx, tmpy, tmpz) *= pou;
double ss = sma1(xcur)*sma2(ycur)*sma3(zcur); double bb = big1(xcur)*big2(ycur)*big3(zcur);
int bi,bj,bk; int oi,oj,ok; fdct3d_position_aux(N1,N2,N3,b, xcur,ycur,zcur, bi,bj,bk,oi,oj,ok);
CpxNumTns& Wblk = W.block(bi,bj,bk);
Wblk(oi,oj,ok) += wpdata(tmpx,tmpy,tmpz) * bb * sqrt(1.0-ss*ss);
}
} //ycur
}//if
wcnt++;
}
}//end of face
//face 2. z x y
for(int g=0; g<nd; g++) {
for(int f=0; f<nd; f++) {
if(crvowners[wcnt]==mpirank) {
double zs = R3/4-(W3/2)/4; double ze = R3;
double xs = -R1 + (2*f-1)*W1/2; double xe = -R1 + (2*f+3)*W1/2;
double ys = -R2 + (2*g-1)*W2/2; double ye = -R2 + (2*g+3)*W2/2;
int xn = int(ceil(xe-xs)); int yn = int(ceil(ye-ys)); int zn = int(ceil(ze-zs));
double thts, thtm, thte; //y to x
if(f==0) {
thts = atan2(-1.0, 1.0-1.0/nd); thtm = atan2(-1.0+1.0/nd, 1.0); thte = atan2(-1.0+3.0/nd, 1.0);
} else if(f==nd-1) {
thts = atan2(-1.0+(2.0*f-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*f+1.0)/nd, 1.0); thte = atan2(1.0, 1.0-1.0/nd);
} else {
thts = atan2(-1.0+(2.0*f-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*f+1.0)/nd, 1.0); thte = atan2(-1.0+(2.0*f+3.0)/nd, 1.0);
}
double phis, phim, phie; //z to x
if(g==0) {
phis = atan2(-1.0, 1.0-1.0/nd); phim = atan2(-1.0+1.0/nd, 1.0); phie = atan2(-1.0+3.0/nd, 1.0);
} else if(g==nd-1) {
phis = atan2(-1.0+(2.0*g-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*g+1.0)/nd, 1.0); phie = atan2(1.0, 1.0-1.0/nd);
} else {
phis = atan2(-1.0+(2.0*g-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*g+1.0)/nd, 1.0); phie = atan2(-1.0+(2.0*g+3.0)/nd, 1.0);
}
int xh = xn/2; int yh = yn/2; int zh = zn/2;
double R13 = double(F1)/double(F3); double R23 = double(F2)/double(F3);
CpxNumTns tpdata(xn,yn,zn);
CpxNumTns& Cblk = C.block(s,wcnt);
tpdata = Cblk;
//fft
fftwnd_plan p = NULL;
map<inttriple, fftwnd_plan>::iterator mit = planmap.find( inttriple(xn, intpair(yn,zn)) );
if(mit!=planmap.end()) { p = (*mit).second;
} else {
p = fftw3d_create_plan(zn, yn, xn, FFTW_FORWARD, FFTW_ESTIMATE | FFTW_IN_PLACE);
planmap[ inttriple(xn, intpair(yn,zn)) ] = p;
}
fftwnd_one(p, (fftw_complex*)tpdata.data(), NULL); //cerr<<"wedge s"<<endl;
double sqrtprod = sqrt(double(xn*yn*zn));
for(int i=0; i<xn; i++) for(int j=0; j<yn; j++) for(int k=0; k<zn; k++) tpdata(i,j,k) /= sqrtprod;
CpxOffTns wpdata(xn,yn,zn);
fdct3d_fftshift(xn,yn,zn,tpdata,wpdata);
for(int zcur=(int)ceil(zs); zcur<ze; zcur++) {
int xfm = (int)ceil( max(-R1, R13*zcur*tan(thts)) );
int xto = (int)floor( min(R1, R13*zcur*tan(thte)) );
int yfm = (int)ceil( max(-R2, R23*zcur*tan(phis)) );
int yto = (int)floor( min(R2, R23*zcur*tan(phie)) );
for(int xcur=xfm; xcur<=xto; xcur++)
for(int ycur=yfm; ycur<=yto; ycur++) {
int tmpx = xcur%xn; if(tmpx<-xh) tmpx+=xn; if(tmpx>=-xh+xn) tmpx-=xn;
int tmpy = ycur%yn; if(tmpy<-yh) tmpy+=yn; if(tmpy>=-yh+yn) tmpy-=yn;
int tmpz = zcur%zn; if(tmpz<-zh) tmpz+=zn; if(tmpz>=-zh+zn) tmpz-=zn;
double thtcur = atan2(xcur/R1, zcur/R3);
double phicur = atan2(ycur/R2, zcur/R3);
double glbpou; fdct3d_globalpou(thtcur, phicur, M_PI/4-atan2(1.0-1.0/nd, 1.0), glbpou);
double wtht;
if(thtcur<thtm) {
if(f==0) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thts)/(thtm-thts), l, r); wtht = l; }
} else {
if(f==nd-1) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thtm)/(thte-thtm), l, r); wtht = r; }
}
double wphi;
if(phicur<phim) {
if(g==0) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phis)/(phim-phis), l, r); wphi = l; }
} else {
if(g==nd-1) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phim)/(phie-phim), l, r); wphi = r; }
}
double pou = glbpou * wtht * wphi;
wpdata(tmpx, tmpy, tmpz) *= pou;
double ss = sma1(xcur)*sma2(ycur)*sma3(zcur); double bb = big1(xcur)*big2(ycur)*big3(zcur);
int bi,bj,bk; int oi,oj,ok; fdct3d_position_aux(N1,N2,N3,b, xcur,ycur,zcur, bi,bj,bk,oi,oj,ok);
CpxNumTns& Wblk = W.block(bi,bj,bk);
Wblk(oi,oj,ok) += wpdata(tmpx,tmpy,tmpz) * bb * sqrt(1.0-ss*ss);
}
}//zcur
}//if
wcnt++;
}
}//end of face
//face 3: -x,-y,-z
for(int h=nd-1; h>=0; h--) {
for(int g=nd-1; g>=0; g--) {
if(crvowners[wcnt]==mpirank) {
double xs = -R1; double xe = -R1/4+(W1/2)/4;
double ys = -R2 + (2*g-1)*W2/2; double ye = -R2 + (2*g+3)*W2/2;
double zs = -R3 + (2*h-1)*W3/2; double ze = -R3 + (2*h+3)*W3/2;
int xn = int(ceil(xe-xs)); int yn = int(ceil(ye-ys)); int zn = int(ceil(ze-zs));
double thts, thtm, thte; //y to x
if(g==0) {
thts = atan2(-1.0, 1.0-1.0/nd); thtm = atan2(-1.0+1.0/nd, 1.0); thte = atan2(-1.0+3.0/nd, 1.0);
} else if(g==nd-1) {
thts = atan2(-1.0+(2.0*g-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*g+1.0)/nd, 1.0); thte = atan2(1.0, 1.0-1.0/nd);
} else {
thts = atan2(-1.0+(2.0*g-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*g+1.0)/nd, 1.0); thte = atan2(-1.0+(2.0*g+3.0)/nd, 1.0);
}
double phis, phim, phie; //z to x
if(h==0) {
phis = atan2(-1.0, 1.0-1.0/nd); phim = atan2(-1.0+1.0/nd, 1.0); phie = atan2(-1.0+3.0/nd, 1.0);
} else if(h==nd-1) {
phis = atan2(-1.0+(2.0*h-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*h+1.0)/nd, 1.0); phie = atan2(1.0, 1.0-1.0/nd);
} else {
phis = atan2(-1.0+(2.0*h-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*h+1.0)/nd, 1.0); phie = atan2(-1.0+(2.0*h+3.0)/nd, 1.0);
}
int xh = xn/2; int yh = yn/2; int zh = zn/2;
double R21 = R2/R1; double R31 = R3/R1;
CpxNumTns tpdata(xn,yn,zn);
CpxNumTns& Cblk = C.block(s,wcnt);
tpdata = Cblk;
//fft
fftwnd_plan p = NULL;
map<inttriple, fftwnd_plan>::iterator mit = planmap.find( inttriple(xn, intpair(yn,zn)) );
if(mit!=planmap.end()) { p = (*mit).second;
} else {
p = fftw3d_create_plan(zn, yn, xn, FFTW_FORWARD, FFTW_ESTIMATE | FFTW_IN_PLACE);
planmap[ inttriple(xn, intpair(yn,zn)) ] = p;
}
fftwnd_one(p, (fftw_complex*)tpdata.data(), NULL); //cerr<<"wedge s"<<endl;
double sqrtprod = sqrt(double(xn*yn*zn));
for(int i=0; i<xn; i++) for(int j=0; j<yn; j++) for(int k=0; k<zn; k++) tpdata(i,j,k) /= sqrtprod;
CpxOffTns wpdata(xn,yn,zn);
fdct3d_fftshift(xn,yn,zn,tpdata,wpdata);
for(int xcur=(int)ceil(xs); xcur<xe; xcur++) {
int yfm = (int)ceil( max(-R2, R21*(-xcur)*tan(thts)) );
int yto = (int)floor( min(R2, R21*(-xcur)*tan(thte)) );
int zfm = (int)ceil( max(-R3, R31*(-xcur)*tan(phis)) );
int zto = (int)floor( min(R3, R31*(-xcur)*tan(phie)) );
for(int ycur=yfm; ycur<=yto; ycur++)
for(int zcur=zfm; zcur<=zto; zcur++) {
int tmpx = xcur%xn; if(tmpx<-xh) tmpx+=xn; if(tmpx>=-xh+xn) tmpx-=xn;
int tmpy = ycur%yn; if(tmpy<-yh) tmpy+=yn; if(tmpy>=-yh+yn) tmpy-=yn;
int tmpz = zcur%zn; if(tmpz<-zh) tmpz+=zn; if(tmpz>=-zh+zn) tmpz-=zn;
double thtcur = atan2(ycur/R2, (-xcur)/R1);
double phicur = atan2(zcur/R3, (-xcur)/R1);
double glbpou; fdct3d_globalpou(thtcur, phicur, M_PI/4-atan2(1.0-1.0/nd, 1.0), glbpou);
double wtht;
if(thtcur<thtm) {
if(g==0) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thts)/(thtm-thts), l, r); wtht = l; }
} else {
if(g==nd-1) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thtm)/(thte-thtm), l, r); wtht = r; }
}
double wphi;
if(phicur<phim) {
if(h==0) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phis)/(phim-phis), l, r); wphi = l; }
} else {
if(h==nd-1) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phim)/(phie-phim), l, r); wphi = r; }
}
double pou = glbpou * wtht * wphi;
wpdata(tmpx, tmpy, tmpz) *= pou;
double ss = sma1(xcur)*sma2(ycur)*sma3(zcur); double bb = big1(xcur)*big2(ycur)*big3(zcur);
int bi,bj,bk; int oi,oj,ok; fdct3d_position_aux(N1,N2,N3,b, xcur,ycur,zcur, bi,bj,bk,oi,oj,ok);
CpxNumTns& Wblk = W.block(bi,bj,bk);
Wblk(oi,oj,ok) += wpdata(tmpx,tmpy,tmpz) * bb * sqrt(1.0-ss*ss);
}
} //xcur
} //if
wcnt++;
}
} //end of face
//face 4: -y,-z,-x
for(int f=nd-1; f>=0; f--) {
for(int h=nd-1; h>=0; h--) {
if(crvowners[wcnt]==mpirank) {
double ys = -R2; double ye = -R2/4+(W2/2)/4;
double zs = -R3 + (2*h-1)*W3/2; double ze = -R3 + (2*h+3)*W3/2;
double xs = -R1 + (2*f-1)*W1/2; double xe = -R1 + (2*f+3)*W1/2;
int xn = int(ceil(xe-xs)); int yn = int(ceil(ye-ys)); int zn = int(ceil(ze-zs));
double thts, thtm, thte; //z to y
if(h==0) {
thts = atan2(-1.0, 1.0-1.0/nd); thtm = atan2(-1.0+1.0/nd, 1.0); thte = atan2(-1.0+3.0/nd, 1.0);
} else if(h==nd-1) {
thts = atan2(-1.0+(2.0*h-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*h+1.0)/nd, 1.0); thte = atan2(1.0, 1.0-1.0/nd);
} else {
thts = atan2(-1.0+(2.0*h-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*h+1.0)/nd, 1.0); thte = atan2(-1.0+(2.0*h+3.0)/nd, 1.0);
}
double phis, phim, phie; //z to x
if(f==0) {
phis = atan2(-1.0, 1.0-1.0/nd); phim = atan2(-1.0+1.0/nd, 1.0); phie = atan2(-1.0+3.0/nd, 1.0);
} else if(f==nd-1) {
phis = atan2(-1.0+(2.0*f-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*f+1.0)/nd, 1.0); phie = atan2(1.0, 1.0-1.0/nd);
} else {
phis = atan2(-1.0+(2.0*f-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*f+1.0)/nd, 1.0); phie = atan2(-1.0+(2.0*f+3.0)/nd, 1.0);
}
int xh = xn/2; int yh = yn/2; int zh = zn/2;
double R32 = double(F3)/double(F2); double R12 = double(F1)/double(F2);
CpxNumTns tpdata(xn,yn,zn);
CpxNumTns& Cblk = C.block(s,wcnt);
tpdata = Cblk;
//fft
fftwnd_plan p = NULL;
map<inttriple, fftwnd_plan>::iterator mit = planmap.find( inttriple(xn, intpair(yn,zn)) );
if(mit!=planmap.end()) { p = (*mit).second;
} else {
p = fftw3d_create_plan(zn, yn, xn, FFTW_FORWARD, FFTW_ESTIMATE | FFTW_IN_PLACE);
planmap[ inttriple(xn, intpair(yn,zn)) ] = p;
}
fftwnd_one(p, (fftw_complex*)tpdata.data(), NULL); //cerr<<"wedge s"<<endl;
double sqrtprod = sqrt(double(xn*yn*zn));
for(int i=0; i<xn; i++) for(int j=0; j<yn; j++) for(int k=0; k<zn; k++) tpdata(i,j,k) /= sqrtprod;
CpxOffTns wpdata(xn,yn,zn);
fdct3d_fftshift(xn,yn,zn,tpdata,wpdata);
for(int ycur=(int)ceil(ys); ycur<ye; ycur++) {
int zfm = (int)ceil( max(-R3, R32*(-ycur)*tan(thts)) );
int zto = (int)floor( min(R3, R32*(-ycur)*tan(thte)) );
int xfm = (int)ceil( max(-R1, R12*(-ycur)*tan(phis)) );
int xto = (int)floor( min(R1, R12*(-ycur)*tan(phie)) );
for(int zcur=zfm; zcur<=zto; zcur++)
for(int xcur=xfm; xcur<=xto; xcur++) {
int tmpx = xcur%xn; if(tmpx<-xh) tmpx+=xn; if(tmpx>=-xh+xn) tmpx-=xn;
int tmpy = ycur%yn; if(tmpy<-yh) tmpy+=yn; if(tmpy>=-yh+yn) tmpy-=yn;
int tmpz = zcur%zn; if(tmpz<-zh) tmpz+=zn; if(tmpz>=-zh+zn) tmpz-=zn;
double thtcur = atan2(zcur/R3, (-ycur)/R2);
double phicur = atan2(xcur/R1, (-ycur)/R2);
double glbpou; fdct3d_globalpou(thtcur, phicur, M_PI/4-atan2(1.0-1.0/nd, 1.0), glbpou); //CHECK
double wtht;
if(thtcur<thtm) {
if(h==0) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thts)/(thtm-thts), l, r); wtht = l; }
} else {
if(h==nd-1) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thtm)/(thte-thtm), l, r); wtht = r; }
}
double wphi;
if(phicur<phim) {
if(f==0) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phis)/(phim-phis), l, r); wphi = l; }
} else {
if(f==nd-1) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phim)/(phie-phim), l, r); wphi = r; }
}
double pou = glbpou * wtht * wphi;
wpdata(tmpx, tmpy, tmpz) *= pou;
double ss = sma1(xcur)*sma2(ycur)*sma3(zcur); double bb = big1(xcur)*big2(ycur)*big3(zcur);
int bi,bj,bk; int oi,oj,ok; fdct3d_position_aux(N1,N2,N3,b, xcur,ycur,zcur, bi,bj,bk,oi,oj,ok);
CpxNumTns& Wblk = W.block(bi,bj,bk);
Wblk(oi,oj,ok) += wpdata(tmpx,tmpy,tmpz) * bb * sqrt(1.0-ss*ss);
}
} //ycur
}//if
wcnt++;
}
}//end of face
//face 5.-z,-x,-y
for(int g=nd-1; g>=0; g--) {
for(int f=nd-1; f>=0; f--) {
if(crvowners[wcnt]==mpirank) {
double zs = -R3; double ze = -R3/4+(W3/2)/4;
double xs = -R1 + (2*f-1)*W1/2; double xe = -R1 + (2*f+3)*W1/2;
double ys = -R2 + (2*g-1)*W2/2; double ye = -R2 + (2*g+3)*W2/2;
int xn = int(ceil(xe-xs)); int yn = int(ceil(ye-ys)); int zn = int(ceil(ze-zs));
double thts, thtm, thte; //y to x
if(f==0) {
thts = atan2(-1.0, 1.0-1.0/nd); thtm = atan2(-1.0+1.0/nd, 1.0); thte = atan2(-1.0+3.0/nd, 1.0);
} else if(f==nd-1) {
thts = atan2(-1.0+(2.0*f-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*f+1.0)/nd, 1.0); thte = atan2(1.0, 1.0-1.0/nd);
} else {
thts = atan2(-1.0+(2.0*f-1.0)/nd, 1.0); thtm = atan2(-1.0+(2.0*f+1.0)/nd, 1.0); thte = atan2(-1.0+(2.0*f+3.0)/nd, 1.0);
}
double phis, phim, phie; //z to x
if(g==0) {
phis = atan2(-1.0, 1.0-1.0/nd); phim = atan2(-1.0+1.0/nd, 1.0); phie = atan2(-1.0+3.0/nd, 1.0);
} else if(g==nd-1) {
phis = atan2(-1.0+(2.0*g-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*g+1.0)/nd, 1.0); phie = atan2(1.0, 1.0-1.0/nd);
} else {
phis = atan2(-1.0+(2.0*g-1.0)/nd, 1.0); phim = atan2(-1.0+(2.0*g+1.0)/nd, 1.0); phie = atan2(-1.0+(2.0*g+3.0)/nd, 1.0);
}
int xh = xn/2; int yh = yn/2; int zh = zn/2;
double R13 = double(F1)/double(F3); double R23 = double(F2)/double(F3);
CpxNumTns tpdata(xn,yn,zn);
CpxNumTns& Cblk = C.block(s,wcnt);
tpdata = Cblk;
//fft
fftwnd_plan p = NULL;
map<inttriple, fftwnd_plan>::iterator mit = planmap.find( inttriple(xn, intpair(yn,zn)) );
if(mit!=planmap.end()) { p = (*mit).second;
} else {
p = fftw3d_create_plan(zn, yn, xn, FFTW_FORWARD, FFTW_ESTIMATE | FFTW_IN_PLACE);
planmap[ inttriple(xn, intpair(yn,zn)) ] = p;
}
fftwnd_one(p, (fftw_complex*)tpdata.data(), NULL); //cerr<<"wedge s"<<endl;
double sqrtprod = sqrt(double(xn*yn*zn));
for(int i=0; i<xn; i++) for(int j=0; j<yn; j++) for(int k=0; k<zn; k++) tpdata(i,j,k) /= sqrtprod;
CpxOffTns wpdata(xn,yn,zn);
fdct3d_fftshift(xn,yn,zn,tpdata,wpdata);
for(int zcur=(int)ceil(zs); zcur<ze; zcur++) {
int xfm = (int)ceil( max(-R1, R13*(-zcur)*tan(thts)) );
int xto = (int)floor( min(R1, R13*(-zcur)*tan(thte)) );
int yfm = (int)ceil( max(-R2, R23*(-zcur)*tan(phis)) );
int yto = (int)floor( min(R2, R23*(-zcur)*tan(phie)) );
for(int xcur=xfm; xcur<=xto; xcur++)
for(int ycur=yfm; ycur<=yto; ycur++) {
int tmpx = xcur%xn; if(tmpx<-xh) tmpx+=xn; if(tmpx>=-xh+xn) tmpx-=xn;
int tmpy = ycur%yn; if(tmpy<-yh) tmpy+=yn; if(tmpy>=-yh+yn) tmpy-=yn;
int tmpz = zcur%zn; if(tmpz<-zh) tmpz+=zn; if(tmpz>=-zh+zn) tmpz-=zn;
double thtcur = atan2(xcur/R1, (-zcur)/R3);
double phicur = atan2(ycur/R2, (-zcur)/R3);
double glbpou; fdct3d_globalpou(thtcur, phicur, M_PI/4-atan2(1.0-1.0/nd, 1.0), glbpou);
double wtht;
if(thtcur<thtm) {
if(f==0) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thts)/(thtm-thts), l, r); wtht = l; }
} else {
if(f==nd-1) wtht = 1;
else { double l,r; fdct3d_window( (thtcur-thtm)/(thte-thtm), l, r); wtht = r; }
}
double wphi;
if(phicur<phim) {
if(g==0) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phis)/(phim-phis), l, r); wphi = l; }
} else {
if(g==nd-1) wphi = 1;
else { double l,r; fdct3d_window( (phicur-phim)/(phie-phim), l, r); wphi = r; }
}
double pou = glbpou * wtht * wphi;
wpdata(tmpx, tmpy, tmpz) *= pou;
double ss = sma1(xcur)*sma2(ycur)*sma3(zcur); double bb = big1(xcur)*big2(ycur)*big3(zcur);
int bi,bj,bk; int oi,oj,ok; fdct3d_position_aux(N1,N2,N3,b, xcur,ycur,zcur, bi,bj,bk,oi,oj,ok);
CpxNumTns& Wblk = W.block(bi,bj,bk);
Wblk(oi,oj,ok) += wpdata(tmpx,tmpy,tmpz) * bb * sqrt(1.0-ss*ss);
}
}//zcur
}//if
wcnt++;
}
}//end of face
iA(wcnt==nd*nd*nf);
//remove plans
for(map<inttriple, fftwnd_plan>::iterator mit=planmap.begin(); mit!=planmap.end(); mit++) {
fftwnd_plan p = (*mit).second;
fftwnd_destroy_plan(p);
}
return 0;
}
