ZeroOrderAssembler.cc 9.5 KB
Newer Older
1
#include <vector>
2
#include <boost/numeric/mtl/mtl.hpp>
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
#include "Assembler.h"
#include "ZeroOrderAssembler.h"
#include "Operator.h"
#include "QPsiPhi.h"
#include "FiniteElemSpace.h"
#include "Quadrature.h"
#include "DOFVector.h"
#include "OpenMP.h"

namespace AMDiS {

  std::vector<SubAssembler*> ZeroOrderAssembler::optimizedSubAssemblers;
  std::vector<SubAssembler*> ZeroOrderAssembler::standardSubAssemblers;

  ZeroOrderAssembler::ZeroOrderAssembler(Operator *op,
					 Assembler *assembler,
					 Quadrature *quad,
					 bool optimized)
    : SubAssembler(op, assembler, quad, 0, optimized)
  {}

  ZeroOrderAssembler* ZeroOrderAssembler::getSubAssembler(Operator* op,
							  Assembler *assembler,
							  Quadrature *quad,
							  bool optimized)
  {
    // check if a assembler is needed at all
30
31
    if (op->zeroOrder.size() == 0)
      return NULL;   
32
33
34
35

    ZeroOrderAssembler *newAssembler;

    std::vector<SubAssembler*> *subAssemblers =
36
      optimized ? &optimizedSubAssemblers : &standardSubAssemblers;
37
38

    int myRank = omp_get_thread_num();
39
    std::vector<OperatorTerm*> opTerms = op->zeroOrder[myRank];
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66

    sort(opTerms.begin(), opTerms.end());

    // check if a new assembler is needed
    if (quad) {
      for (int i = 0; i < static_cast<int>( subAssemblers->size()); i++) {
	std::vector<OperatorTerm*> assTerms = *((*subAssemblers)[i]->getTerms());

	sort(assTerms.begin(), assTerms.end());

	if ((opTerms == assTerms) && 
	    ((*subAssemblers)[i]->getQuadrature() == quad)) {
	  return dynamic_cast<ZeroOrderAssembler*>((*subAssemblers)[i]);
	}
      }
    }
 
    // check if all terms are pw_const
    bool pwConst = true;
    for (int i = 0; i < static_cast<int>( op->zeroOrder[myRank].size()); i++) {
      if (!op->zeroOrder[myRank][i]->isPWConst()) {
	pwConst = false;
	break;
      }
    }  

    // create new assembler
67
68
69
70
71
72
73
74
75
    if (!optimized) {
	newAssembler = NEW StandardZOA(op, assembler, quad);
    } else {
      if (pwConst) {
	  newAssembler = NEW PrecalcZOA(op, assembler, quad);
      } else {
	  newAssembler = NEW FastQuadZOA(op, assembler, quad);
      }
    }
76
77
78
79
80
81
82

    subAssemblers->push_back(newAssembler);
    return newAssembler;
  }

  StandardZOA::StandardZOA(Operator *op, Assembler *assembler, Quadrature *quad)
    : ZeroOrderAssembler(op, assembler, quad, false)
Thomas Witkowski's avatar
Thomas Witkowski committed
83
  {}
84

85
  void StandardZOA::calculateElementMatrix(const ElInfo *elInfo, ElementMatrix& mat)
86
87
88
89
90
  {
    const BasisFunction *psi = owner->getRowFESpace()->getBasisFcts();
    const BasisFunction *phi = owner->getColFESpace()->getBasisFcts();

    int nPoints = quadrature->getNumPoints();
91
92
    std::vector<double> c(nPoints, 0.0);
    std::vector<double> phival(nCol);
93
94
95
96
97
98
99
100

    int myRank = omp_get_thread_num();
    std::vector<OperatorTerm*>::iterator termIt;
    for (termIt = terms[myRank].begin(); termIt != terms[myRank].end(); ++termIt) {
      (static_cast<ZeroOrderTerm*>((*termIt)))->getC(elInfo, nPoints, c);
    }
      
    if (symmetric) {
101
102
      TEST_EXIT_DBG(nCol == nRow)("nCol != nRow, but symmetric assembling!\n");
            
103
104
105
106
107
108
109
110
111
112
      for (int iq = 0; iq < nPoints; iq++) {
	c[iq] *= elInfo->getDet();

	// calculate phi at QPs only once!
	for (int i = 0; i < nCol; i++) {
	  phival[i] = (*(phi->getPhi(i)))(quadrature->getLambda(iq));
	}

	for (int i = 0; i < nRow; i++) {
	  double psival = (*(psi->getPhi(i)))(quadrature->getLambda(iq));
113
	  mat[i][i] += quadrature->getWeight(iq) * c[iq] * psival * phival[i];
114
115
	  for (int j = i + 1; j < nCol; j++) {
	    double val = quadrature->getWeight(iq) * c[iq] * psival * phival[j];
116
117
	    mat[i][j] += val;
	    mat[j][i] += val;
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
	  }
	}
      }
    } else {      //  non symmetric assembling 
      for (int iq = 0; iq < nPoints; iq++) {
	c[iq] *= elInfo->getDet();

	// calculate phi at QPs only once!
	for (int i = 0; i < nCol; i++) {
	  phival[i] = (*(phi->getPhi(i)))(quadrature->getLambda(iq));
	}

	for (int i = 0; i < nRow; i++) {
	  double psival = (*(psi->getPhi(i)))(quadrature->getLambda(iq));
	  for (int j = 0; j < nCol; j++) {
133
	    mat[i][j] += quadrature->getWeight(iq) * c[iq] * psival * phival[j];
134
135
136
137
138
139
	  }
	}
      }
    }
  }

140
  void StandardZOA::calculateElementVector(const ElInfo *elInfo, ElementVector& vec)
141
142
  {
    int nPoints = quadrature->getNumPoints();
143
    std::vector<double> c(nPoints, 0.0);
144
145
146
147
148
149
150
151
152
153
154
155
156

    int myRank = omp_get_thread_num();
    std::vector<OperatorTerm*>::iterator termIt;
    for (termIt = terms[myRank].begin(); termIt != terms[myRank].end(); ++termIt) {
      (static_cast<ZeroOrderTerm*>((*termIt)))->getC(elInfo, nPoints, c);
    }

    for (int iq = 0; iq < nPoints; iq++) {
      c[iq] *= elInfo->getDet();

      for (int i = 0; i < nRow; i++) {
	double psi = (*(owner->getRowFESpace()->getBasisFcts()->getPhi(i)))
	  (quadrature->getLambda(iq));
157
	vec[i] += quadrature->getWeight(iq) * c[iq] * psi;
158
159
160
161
162
163
      }
    }
  }

  FastQuadZOA::FastQuadZOA(Operator *op, Assembler *assembler, Quadrature *quad)
    : ZeroOrderAssembler(op, assembler, quad, true)
164
  {}
165

166
  void FastQuadZOA::calculateElementMatrix(const ElInfo *elInfo, ElementMatrix& mat)
167
168
169
170
171
  {
    int nPoints = quadrature->getNumPoints();
    int myRank = omp_get_thread_num();

    if (firstCall) {
172
173
174
175
176
177
178
179
180
181
#ifdef _OPENMP
#pragma omp critical
#endif 
      {
	const BasisFunction *basFcts = owner->getRowFESpace()->getBasisFcts();
	psiFast = updateFastQuadrature(psiFast, basFcts, INIT_PHI);
	basFcts = owner->getColFESpace()->getBasisFcts();
	phiFast = updateFastQuadrature(phiFast, basFcts, INIT_PHI);
	firstCall = false;
      }
182
183
    }

184
    std::vector<double> c(nPoints, 0.0);
185
186
187
188
189
190
    std::vector<OperatorTerm*>::iterator termIt;
    for (termIt = terms[myRank].begin(); termIt != terms[myRank].end(); ++termIt) {
      (static_cast<ZeroOrderTerm*>((*termIt)))->getC(elInfo, nPoints, c);
    }

    if (symmetric) {
191
192
      TEST_EXIT_DBG(nCol == nRow)("nCol != nRow, but symmetric assembling!\n");

193
194
195
196
197
198
      for (int iq = 0; iq < nPoints; iq++) {
	c[iq] *= elInfo->getDet();

	const double *psi = psiFast->getPhi(iq);
	const double *phi = phiFast->getPhi(iq);
	for (int i = 0; i < nRow; i++) {
199
	  mat[i][i] += quadrature->getWeight(iq) * c[iq] * psi[i] * phi[i];
200
201
	  for (int j = i + 1; j < nCol; j++) {
	    double val = quadrature->getWeight(iq) * c[iq] * psi[i] * phi[j];
202
203
	    mat[i][j] += val;
	    mat[j][i] += val;
204
205
206
207
208
209
210
211
212
213
214
	  }
	}
      }
    } else {      /*  non symmetric assembling   */
      for (int iq = 0; iq < nPoints; iq++) {
	c[iq] *= elInfo->getDet();

	const double *psi = psiFast->getPhi(iq);
	const double *phi = phiFast->getPhi(iq);
	for (int i = 0; i < nRow; i++) {
	  for (int j = 0; j < nCol; j++) {
215
	    mat[i][j] += quadrature->getWeight(iq) * c[iq] * psi[i] * phi[j];
216
217
218
219
220
	  }
	}
      }
    }
  }
Thomas Witkowski's avatar
Thomas Witkowski committed
221

222
  void FastQuadZOA::calculateElementVector(const ElInfo *elInfo, ElementVector& vec)
223
  {
224
225
226
    int myRank = omp_get_thread_num();
    int nPoints = quadrature->getNumPoints();

227
    if (firstCall) {
228
229
230
231
232
233
234
235
236
237
#ifdef _OPENMP
#pragma omp critical
#endif 
      {
	const BasisFunction *basFcts = owner->getRowFESpace()->getBasisFcts();
	psiFast = updateFastQuadrature(psiFast, basFcts, INIT_PHI);
	basFcts = owner->getColFESpace()->getBasisFcts();
	phiFast = updateFastQuadrature(phiFast, basFcts, INIT_PHI);
	firstCall = false;
      }
238
239
    }

240
    std::vector<double> c(nPoints, 0.0);
241
242
243
244
245
246
247
248
249
250
    std::vector<OperatorTerm*>::iterator termIt;
    for (termIt = terms[myRank].begin(); termIt != terms[myRank].end(); ++termIt) {
      (static_cast<ZeroOrderTerm*>((*termIt)))->getC(elInfo, nPoints, c);
    }

    for (int iq = 0; iq < nPoints; iq++) {
      c[iq] *= elInfo->getDet();

      const double *psi = psiFast->getPhi(iq);
      for (int i = 0; i < nRow; i++) {
251
	vec[i] += quadrature->getWeight(iq) * c[iq] * psi[i];
252
253
254
255
256
257
258
259
260
      }
    }
  }

  PrecalcZOA::PrecalcZOA(Operator *op, Assembler *assembler, Quadrature *quad) 
    : ZeroOrderAssembler(op, assembler, quad, true)
  {
  }

261
  void PrecalcZOA::calculateElementMatrix(const ElInfo *elInfo, ElementMatrix& mat)
262
263
  {
    if (firstCall) {
264
265
266
267
268
269
270
271
272
273
274
#ifdef _OPENMP
#pragma omp critical
#endif 
      {
	q00 = Q00PsiPhi::provideQ00PsiPhi(owner->getRowFESpace()->getBasisFcts(), 
					  owner->getColFESpace()->getBasisFcts(), 
					  quadrature);
	q0 = Q0Psi::provideQ0Psi(owner->getRowFESpace()->getBasisFcts(),
				 quadrature);
	firstCall = false;
      }
275
276
    }

277
    std::vector<double> c(1, 0.0);
278
279
280
281
    int myRank = omp_get_thread_num();
    int size = static_cast<int>(terms[myRank].size());

    for (int i = 0; i < size; i++) {
282
      (static_cast<ZeroOrderTerm*>((terms[myRank][i])))->getC(elInfo, 1, c);
283
284
    }

285
    c[0] *= elInfo->getDet();
286
287
288

    if (symmetric) {
      for (int i = 0; i < nRow; i++) {
289
	mat[i][i] += c[0] * q00->getValue(i,i);
290
	for (int j = i + 1; j < nCol; j++) {
291
	  double val = c[0] * q00->getValue(i, j);
292
293
	  mat[i][j] += val;
	  mat[j][i] += val;
294
295
296
	}
      }
    } else {
297
      for (int i = 0; i < nRow; i++) {
Thomas Witkowski's avatar
Thomas Witkowski committed
298
	for (int j = 0; j < nCol; j++) {
299
	  mat[i][j] += c[0] * q00->getValue(i, j);
Thomas Witkowski's avatar
Thomas Witkowski committed
300
	}
301
      }
302
303
304
    }
  }

305
  void PrecalcZOA::calculateElementVector(const ElInfo *elInfo, ElementVector& vec)
306
307
  {
    if (firstCall) {
308
309
310
311
312
313
314
315
316
317
318
#ifdef _OPENMP
#pragma omp critical
#endif 
      {
	q00 = Q00PsiPhi::provideQ00PsiPhi(owner->getRowFESpace()->getBasisFcts(), 
					  owner->getColFESpace()->getBasisFcts(), 
					  quadrature);
	q0 = Q0Psi::provideQ0Psi(owner->getRowFESpace()->getBasisFcts(),
				 quadrature);	
	firstCall = false;
      }
319
320
321
322
323
    }

    std::vector<OperatorTerm*>::iterator termIt;

    int myRank = omp_get_thread_num();
324
    std::vector<double> c(1, 0.0);
325
    for (termIt = terms[myRank].begin(); termIt != terms[myRank].end(); ++termIt)
326
      (static_cast<ZeroOrderTerm*>( *termIt))->getC(elInfo, 1, c);
327

328
    c[0] *= elInfo->getDet();
329
330

    for (int i = 0; i < nRow; i++)
331
      vec[i] += c[0] * q0->getValue(i);
332
333
334
  }

}