interpol.cc 13 KB
Newer Older
Phillip Lino Rall's avatar
Phillip Lino Rall committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
/**********************************************************************************
 * Copyright 2010 Christoph Pflaum 
 * 		Department Informatik Lehrstuhl 10 - Systemsimulation
 *		Friedrich-Alexander Universität Erlangen-Nürnberg
 * 
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 * http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 **********************************************************************************/


#include "../mympi.h"
#include "../abbrevi.h"
#include "../parameter.h"
#include "../math_lib/math_lib.h"
#include "../basics/basic.h"
#include "../grid/elements.h"
#include "../grid/parti.h"
#include "../grid/ug.h"
#include "../grid/blockgrid.h"
#include "../grid/marker.h"
#include "../extemp/extemp.h"
#include "../extemp/parallel.h"
#include "../extemp/variable.h"
Phillip Lino Rall's avatar
Phillip Lino Rall committed
33
#include "../extemp/cellvar.h"
Phillip Lino Rall's avatar
Phillip Lino Rall committed
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
#include "../extemp/co_fu.h"
#include "../extemp/functor.h"
#include "interpol.h"

#include "assert.h"

/////////////////////////////////////////////////////////////
// 1. Interpolate from  blockgrid to rectangular blockgrid
/////////////////////////////////////////////////////////////


bool contained_in_tet(D3vector lam) {
  if(lam.x < -0.1)                 return false;
  if(lam.y < -0.1)                 return false;
  if(lam.z < -0.1)                 return false;
  if(lam.x + lam.y + lam.z > 1.1)  return false;
  return true;
}

bool new_lam_worse(D3vector lam_old, D3vector lam_new) {
  if(MIN(lam_new) < MIN(lam_old) &&  MIN(lam_old) < -0.1) return true;
  if(MAX(lam_new) > MAX(lam_old) &&  MAX(lam_old) >  1.1) return true;
  return false;
}

Phillip Lino Rall's avatar
Phillip Lino Rall committed
59
60
61
62
63
Interpolate_on_structured_grid::~Interpolate_on_structured_grid() {
  delete[] ids_hex;
  delete[] ids_i;
  delete[] ids_j;
  delete[] ids_k;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
64

Phillip Lino Rall's avatar
Phillip Lino Rall committed
65
  delete[] typ_tet;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
66

Phillip Lino Rall's avatar
Phillip Lino Rall committed
67
  delete[] lambda;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
68
69
70
71
72
73
}

Interpolate_on_structured_grid::Interpolate_on_structured_grid(int nx_, int ny_, int nz_,
							       D3vector pWSD, D3vector pENT,
							       Blockgrid& blockgrid_) {
  int Nx, Ny, Nz;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
74
  // int typ;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
75
76
77
78
79

  assert(nx_ > 1);
  assert(ny_ > 1);
  assert(nz_ > 1);

Phillip Lino Rall's avatar
Phillip Lino Rall committed
80
81
  //int ilmin, jlmin, klmin;
  //int ilmax, jlmax, klmax;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
82
83
84
85

  double factor = 0.1;
  //  double factor = 0.00001;

Phillip Lino Rall's avatar
Phillip Lino Rall committed
86
  // D3vector lam;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109

  blockgrid = &blockgrid_;
  ug = blockgrid->Give_unstructured_grid();

  nx = nx_;
  ny = ny_;
  nz = nz_;

  if(nx_>1)
    hx = (pENT.x - pWSD.x) / (nx_-1);
  else  
    hx = 1.0;
  if(ny_>1)
    hy = (pENT.y - pWSD.y) / (ny_-1);
  else  
    hy = 1.0;
  if(nz_>1)
    hz = (pENT.z - pWSD.z) / (nz_-1);
  else 
    hz = 1.0;

  int num_total = nx * ny * nz;

Phillip Lino Rall's avatar
Phillip Lino Rall committed
110
  /*
Phillip Lino Rall's avatar
Phillip Lino Rall committed
111
112
113
114
115
  D3vector cWSD, cESD;
  D3vector cWND, cEND;

  D3vector cWST, cEST;
  D3vector cWNT, cENT;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
116
*/
Phillip Lino Rall's avatar
Phillip Lino Rall committed
117
  
Phillip Lino Rall's avatar
Phillip Lino Rall committed
118
  // D3vector boxWSD, boxENT;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
119

Phillip Lino Rall's avatar
Phillip Lino Rall committed
120
  // D3vector ploc;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137

  ids_hex = new int[num_total];

  ids_i = new int[num_total];
  ids_j = new int[num_total];
  ids_k = new int[num_total];

  typ_tet = new int[num_total];

  lambda = new D3vector[num_total];

  for(int i=0;i<num_total;++i) ids_hex[i] = -1;

  for(int id_hex=0;id_hex<ug->Give_number_hexahedra();++id_hex) {
      Nx = blockgrid->Give_Nx_hexahedron(id_hex);
      Ny = blockgrid->Give_Ny_hexahedron(id_hex);
      Nz = blockgrid->Give_Nz_hexahedron(id_hex);
Phillip Lino Rall's avatar
Phillip Lino Rall committed
138
139
      
#pragma omp parallel for num_threads(UGBlocks::numThreadsToTake) if(UGBlocks::useOpenMP)
Phillip Lino Rall's avatar
Phillip Lino Rall committed
140
141
142
143
      for(int k=0;k<Nz;++k)
	for(int j=0;j<Ny;++j)
	  for(int i=0;i<Nx;++i) {
            // corner points of general hex-cell
Phillip Lino Rall's avatar
Phillip Lino Rall committed
144
145
146
147
	    D3vector cWSD = blockgrid->Give_coord_hexahedron(id_hex,i,  j,  k  );
	    D3vector cESD = blockgrid->Give_coord_hexahedron(id_hex,i+1,j  ,k  );
	    D3vector cWND = blockgrid->Give_coord_hexahedron(id_hex,i,  j+1,k  );
	    D3vector cEND = blockgrid->Give_coord_hexahedron(id_hex,i+1,j+1,k  );
Phillip Lino Rall's avatar
Phillip Lino Rall committed
148

Phillip Lino Rall's avatar
Phillip Lino Rall committed
149
150
151
152
	    D3vector cWST = blockgrid->Give_coord_hexahedron(id_hex,i,  j,  k+1);
	    D3vector cEST = blockgrid->Give_coord_hexahedron(id_hex,i+1,j  ,k+1);
	    D3vector cWNT = blockgrid->Give_coord_hexahedron(id_hex,i,  j+1,k+1);
	    D3vector cENT = blockgrid->Give_coord_hexahedron(id_hex,i+1,j+1,k+1);
Phillip Lino Rall's avatar
Phillip Lino Rall committed
153
154

            // bounding box calculation 
Phillip Lino Rall's avatar
Phillip Lino Rall committed
155
	    D3vector boxWSD, boxENT;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
	    boxWSD.x = MIN(MIN(MIN(cWSD.x,cESD.x),MIN(cWND.x,cEND.x)),
			   MIN(MIN(cWST.x,cEST.x),MIN(cWNT.x,cENT.x))) - factor *hx;
	    boxWSD.y = MIN(MIN(MIN(cWSD.y,cESD.y),MIN(cWND.y,cEND.y)),
			   MIN(MIN(cWST.y,cEST.y),MIN(cWNT.y,cENT.y))) - factor *hy;
	    boxWSD.z = MIN(MIN(MIN(cWSD.z,cESD.z),MIN(cWND.z,cEND.z)),
			   MIN(MIN(cWST.z,cEST.z),MIN(cWNT.z,cENT.z))) - factor *hz;

	    boxENT.x = MAX(MAX(MAX(cWSD.x,cESD.x),MAX(cWND.x,cEND.x)),
			   MAX(MAX(cWST.x,cEST.x),MAX(cWNT.x,cENT.x))) + factor *hx;
	    boxENT.y = MAX(MAX(MAX(cWSD.y,cESD.y),MAX(cWND.y,cEND.y)),
			   MAX(MAX(cWST.y,cEST.y),MAX(cWNT.y,cENT.y))) + factor *hy;
	    boxENT.z = MAX(MAX(MAX(cWSD.z,cESD.z),MAX(cWND.z,cEND.z)),
			   MAX(MAX(cWST.z,cEST.z),MAX(cWNT.z,cENT.z))) + factor *hz;

	    // calculation of indices of a collection of cells of structured grid which contains bounding box
Phillip Lino Rall's avatar
Phillip Lino Rall committed
171
172
173
	    int ilmin = Ganzzahliger_Anteil((boxWSD.x - pWSD.x) / hx);
	    int jlmin = Ganzzahliger_Anteil((boxWSD.y - pWSD.y) / hy);
	    int klmin = Ganzzahliger_Anteil((boxWSD.z - pWSD.z) / hz);
Phillip Lino Rall's avatar
Phillip Lino Rall committed
174
175
	    

Phillip Lino Rall's avatar
Phillip Lino Rall committed
176
177
178
	    int ilmax = Ganzzahliger_Anteil((boxENT.x - pWSD.x) / hx);
	    int jlmax = Ganzzahliger_Anteil((boxENT.y - pWSD.y) / hy);
	    int klmax = Ganzzahliger_Anteil((boxENT.z - pWSD.z) / hz);
Phillip Lino Rall's avatar
Phillip Lino Rall committed
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220

	    /*
	    cout << " indices: "
		 << " ilmin: " << ilmin 
		 << " jlmin: " << jlmin 
		 << " klmin: " << klmin 
		 << " ilmax: " << ilmax 
		 << " jlmax: " << jlmax 
		 << " klmax: " << klmax 
		 << " boxWSD.x: " << boxWSD.x
		 << " cWSD.x: " << cWSD.x
		 << " Nx: " <<  Nx
		 << endl;
	    */
	    /*	    
bool now;
if(boxWSD.z < 0 && boxENT.z > 0.0 && boxWSD.y < 0.5 && boxENT.y > 0.5 && boxWSD.x < 1.0 && boxENT.x > 1.0 ) {
  cout << "\n \n WSD   : ";  boxWSD.Print();
  cout << "\n ENT  : ";  boxENT.Print();
  now = true;
 }
 else now = false;

 
 cout << " tt: " << boxWSD.x << " " << pWSD.x << " " << hx << endl;
 cout << (boxWSD.x - pWSD.x) << endl;

 cout << " z: " << 0.1 << " g: " << Ganzzahliger_Anteil(0.1) << endl;
 cout << " z: " << -0.1 << " g: " << Ganzzahliger_Anteil(-0.1) << endl;

 cout << " z: " << 5.1 << " g: " << Ganzzahliger_Anteil(5.1) << endl;
 cout << " z: " << -5.1 << " g: " << Ganzzahliger_Anteil(-5.1) << endl;
	    */

	    if(ilmin<0) ilmin=0;
	    if(jlmin<0) jlmin=0;
	    if(klmin<0) klmin=0;

	    for(int il = ilmin; (il <= ilmax) && (il < nx_);++il)
	      for(int jl = jlmin; (jl <= jlmax) && (jl < ny_);++jl)
		for(int kl = klmin; (kl <= klmax) && (kl < nz_);++kl) {

Phillip Lino Rall's avatar
Phillip Lino Rall committed
221
		  D3vector ploc = D3vector(il * hx, jl * hy, kl * hz) + pWSD;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
222
223
224

		  //		  cout << "HI" << endl;

Phillip Lino Rall's avatar
Phillip Lino Rall committed
225
		  int typ = -1;
Phillip Lino Rall's avatar
Phillip Lino Rall committed
226

Phillip Lino Rall's avatar
Phillip Lino Rall committed
227
		  D3vector lam = lambda_of_p_in_tet(ploc,cWND,cWNT,cWST,cEST);
Phillip Lino Rall's avatar
Phillip Lino Rall committed
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
		  if(contained_in_tet(lam)) typ=0;
		  else {
		    lam = lambda_of_p_in_tet(ploc,cEST,cWND,cWST,cESD);
		    if(contained_in_tet(lam)) typ=1;
		    else {
		      lam = lambda_of_p_in_tet(ploc,cWND,cWSD,cWST,cESD);
		      if(contained_in_tet(lam)) typ=2;
		      else {
			lam = lambda_of_p_in_tet(ploc,cEST,cWND,cESD,cEND);
			if(contained_in_tet(lam)) typ=3;
			else {
			  lam = lambda_of_p_in_tet(ploc,cENT,cWNT,cEST,cEND);
			  if(contained_in_tet(lam)) typ=4;
			  else {
			    lam = lambda_of_p_in_tet(ploc,cWNT,cWND,cEST,cEND);
			    if(contained_in_tet(lam)) typ=5;
			  }
			}
		      }
		    }
		  }

		  /*		  
		  cout << " typ " << typ << id_hex 
		       << " il: " << il 
		       << " jl: " << jl 
		       << " kl: " << kl 
		       << endl; 
		  */

		  if(typ!=-1) {
		    int ind_global;
		    ind_global = il+nx*(jl+ny*kl);      
		    bool stop;
		    stop=false;

		    if(ids_hex[ind_global]!=-1) {
		      stop=new_lam_worse(lambda[ind_global],lam);
		    }

Phillip Lino Rall's avatar
Phillip Lino Rall committed
268
		    #pragma omp critical
Phillip Lino Rall's avatar
Phillip Lino Rall committed
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
		    if(stop==false) {
		      ids_hex[ind_global] = id_hex;
		      ids_i[ind_global] = i;
		      ids_j[ind_global] = j;
		      ids_k[ind_global] = k;
		      
		      typ_tet[ind_global] = typ;
		      
		      lambda[ind_global] = lam;
		    }
		    //go_on = false;
		  }

		  /*
		  cout << " out "
		       << " ilmin: " << ilmin
		       << " ilmax: " << ilmax
		       << " jlmin: " << jlmin
		       << " jlmax: " << jlmax
		       << " klmin: " << klmin
		       << " klmax: " << klmax;
		  cout << "\n   "; cWSD.Print();
		  cout << "\n   "; cESD.Print();
		  cout << "\n   "; cWND.Print();
		  cout << "\n   "; cEND.Print();
		  cout << "\n   "; cWST.Print();
		  cout << "\n   "; cEST.Print();
		  cout << "\n   "; cWNT.Print();
		  cout << "\n   "; cENT.Print();
		  cout << "\n   p: "; ploc.Print();

		  cout << "\n   : ";  boxWSD.Print();
		  cout << "\n   : ";  boxENT.Print();

		  cout << endl;
		  */
		}
	  }
  }


  for(int i=0;i<num_total;++i) {
    if(ids_hex[i]==-1) {
      // wir nehmen default value!!
      /*
      cout << i 
	   << " Error: Interpolate_on_structured_grid: I cannot interpolate all data!"
	   << endl;
      ids_hex[i] = 0;
      */
    }
    else {
      //cout << i << " Interpolate_on_structured_grid: o.k.!" << endl;
    }
  }
}

/////////////////////////////////////////////////////////////
// 2. Interpolate from  blockgrid  to  blockgrid
/////////////////////////////////////////////////////////////


Phillip Lino Rall's avatar
Phillip Lino Rall committed
331
  
Phillip Lino Rall's avatar
Phillip Lino Rall committed
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
Interpolate_on_block_grid::Interpolate_on_block_grid(int nx_, int ny_, int nz_,
				                     Blockgrid* blockgrid_from, Blockgrid* blockgrid_to_) {
    nx = nx_;
    ny = ny_;
    nz = nz_;
 
    if(nx<=2) nx = 3;
    if(ny<=2) ny = 3;
    if(nz<=2) nz = 3;
     
    blockgrid_to = blockgrid_to_;
    
    //Variable<double> coordXYZ(*blockgrid);
    X_coordinate Xc(*blockgrid_to);
    Y_coordinate Yc(*blockgrid_to);
    Z_coordinate Zc(*blockgrid_to);
    
    pWSD.x = Minimum(Xc);    pWSD.y = Minimum(Yc);    pWSD.z = Minimum(Zc);
    pENT.x = Maximum(Xc);    pENT.y = Maximum(Yc);    pENT.z = Maximum(Zc);  

    interpolatorStructured = new Interpolate_on_structured_grid(nx,ny,nz, pWSD, pENT, *blockgrid_from);
    data = new double[nx*ny*nz];
    
    
Phillip Lino Rall's avatar
Phillip Lino Rall committed
356
357
358
    hx = (pENT.x - pWSD.x) / (nx-1);  // geandert nach Rall-Vorschlag von    nx+1   zu nx-1
    hy = (pENT.y - pWSD.y) / (ny-1);
    hz = (pENT.z - pWSD.z) / (nz-1);    
Phillip Lino Rall's avatar
Phillip Lino Rall committed
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
    
    
    /*
    
    // test GGGG
    cout << "\n WSD: " ; pWSD.Print();
    cout << "\n ENT: " ; pENT.Print();
    cout << "nx: " << nx << " ny: " << ny << " nz: " << nz << endl;
    */
}
  

  
void Interpolate_on_block_grid::interpolate(Variable<double>* U_from, Variable<double>* U_to,
					    double defaultInterpolation) {
/*
   //test GGGG
   X_coordinate Xfrom(*U_from->Give_blockgrid());
  (*U_from) = Xfrom;  
*/  
    interpolatorStructured->interpolate<double>(*U_from,data,defaultInterpolation);

    /*
 //test GGGG
    for(int i=0;i<Nx;++i) for(int j=0;j<nz;++j) for(int k=0;k<nz;++k) 
       data[i    +nx*(j    +ny* k)] = hx * i;
      */
      
    Functor3<double,double,Interpolate_on_block_grid> myFunctor(this);
    
    X_coordinate Xc(*blockgrid_to);
    Y_coordinate Yc(*blockgrid_to);
    Z_coordinate Zc(*blockgrid_to);
    
    (*U_to) = myFunctor(Xc,Yc,Zc);
}
 
double Interpolate_on_block_grid::evaluate(double coord_x, double coord_y, double coord_z) {  
  if(coord_x > pENT.x) return 0.0;
  if(coord_x < pWSD.x) return 0.0;
  if(coord_y > pENT.y) return 0.0;
  if(coord_y < pWSD.y) return 0.0;
  if(coord_z > pENT.z) return 0.0;
  if(coord_z < pWSD.z) return 0.0;
  
  int i = (coord_x - pWSD.x) / hx;   
  int j = (coord_y - pWSD.y) / hy;   
  int k = (coord_z - pWSD.z) / hz;   
    
  if(i < 0)   i=0;     if(j <0   ) j=0;     if(k<0)     k=0;
  if(i>=nx-1) i=nx-2;  if(j>=ny-1) j=ny-2;  if(k>=nz-1) k=nz-2;
  
  //cout << "i: " << i << " j: " << j << " k: " << k << endl;
    
    
  double uWSD = data[i    +nx*(j    +ny* k)];
  double uESD = data[(i+1)+nx*(j    +ny* k)];
  double uWND = data[i    +nx*((j+1)+ny* k)];
  double uEND = data[(i+1)+nx*((j+1)+ny* k)];
  double uWST = data[i    +nx*(j    +ny*(k+1))];
  double uEST = data[(i+1)+nx*(j    +ny*(k+1))];
  double uWNT = data[i    +nx*((j+1)+ny*(k+1))];
  double uENT = data[(i+1)+nx*((j+1)+ny*(k+1))];
  
  
  // assert( (i+1)+nx*((j+1)+ny*(k+1)) < nx*ny*nz);
  
  double locX = (coord_x - pWSD.x) / hx - i;
  double locY = (coord_y - pWSD.y) / hy - j;
  double locZ = (coord_z - pWSD.z) / hz - k;
  
Phillip Lino Rall's avatar
Phillip Lino Rall committed
430
431
  //return uWSD;
  
Phillip Lino Rall's avatar
Phillip Lino Rall committed
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
  return uWSD * (1.0 - locX) * (1.0 - locY) * (1.0 - locZ) +
         uESD *        locX  * (1.0 - locY) * (1.0 - locZ) +
         uWND * (1.0 - locX) *        locY  * (1.0 - locZ) +
         uEND *        locX  *        locY  * (1.0 - locZ) +
         uWST * (1.0 - locX) * (1.0 - locY) *        locZ  +
         uEST *        locX  * (1.0 - locY) *        locZ  +
         uWNT * (1.0 - locX) *        locY  *        locZ  +
         uENT *        locX  *        locY  *        locZ;
}
 
Interpolate_on_block_grid::~Interpolate_on_block_grid() {
    delete interpolatorStructured;
    delete[] data;
}