ResidualEstimator.cc 16.4 KB
Newer Older
1
2
3
4
5
6
7
8
#include "ResidualEstimator.h"
#include "Operator.h"
#include "DOFMatrix.h"
#include "DOFVector.h"
#include "Assembler.h"
#include "Traverse.h"
#include "Parameters.h"

9
10
11
12
#ifdef HAVE_PARALLEL_DOMAIN_AMDIS
#include "mpi.h"
#endif

13
14
namespace AMDiS {

15
  ResidualEstimator::ResidualEstimator(std::string name, int r) 
16
    : Estimator(name, r),
17
18
      C0(0.0), 
      C1(0.0), 
19
      C2(0.0), 
20
      C3(0.0),
21
      jumpResidualOnly(false)
22
  {
23
24
    FUNCNAME("ResidualEstimator::ResidualEstimator()");

25
26
27
28
29
30
31
32
33
    GET_PARAMETER(0, name + "->C0", "%f", &C0);
    GET_PARAMETER(0, name + "->C1", "%f", &C1);
    GET_PARAMETER(0, name + "->C2", "%f", &C2);
    GET_PARAMETER(0, name + "->C3", "%f", &C3);

    C0 = C0 > 1.e-25 ? sqr(C0) : 0.0;
    C1 = C1 > 1.e-25 ? sqr(C1) : 0.0;
    C2 = C2 > 1.e-25 ? sqr(C2) : 0.0;
    C3 = C3 > 1.e-25 ? sqr(C3) : 0.0;
34

35
36
37
38
    if (C1 != 0.0 && C0 == 0.0 && C3 == 0.0)
      jumpResidualOnly = true;
      

39
    TEST_EXIT(C2 == 0.0)("C2 is not used! Please remove it or set it to 0.0!\n");
40
41
  }

42

43
44
45
  void ResidualEstimator::init(double ts)
  {
    FUNCNAME("ResidualEstimator::init()");
46

47
    timestep = ts;
Thomas Witkowski's avatar
Thomas Witkowski committed
48
    nSystems = static_cast<int>(uh.size());
49

Thomas Witkowski's avatar
Thomas Witkowski committed
50
    TEST_EXIT_DBG(nSystems > 0)("no system set\n");
51
52

    dim = mesh->getDim();
53
54
    basFcts = new const BasisFunction*[nSystems];
    quadFast = new FastQuadrature*[nSystems];
55
56

    degree = 0;
Thomas Witkowski's avatar
Thomas Witkowski committed
57
    for (int system = 0; system < nSystems; system++) {
58
      basFcts[system] = uh[system]->getFeSpace()->getBasisFcts();
59
      degree = std::max(degree, basFcts[system]->getDegree());
60
61
62
63
    }
    degree *= 2;

    quad = Quadrature::provideQuadrature(dim, degree);
Thomas Witkowski's avatar
Thomas Witkowski committed
64
    nPoints = quad->getNumPoints();
65
66

    Flag flag = INIT_PHI | INIT_GRD_PHI;
67
68
    if (degree > 2)
      flag |= INIT_D2_PHI;    
69

70
    for (int system = 0; system < nSystems; system++)
71
72
      quadFast[system] = FastQuadrature::provideFastQuadrature(basFcts[system], 
							       *quad, 
73
							       flag);    
74
  
75
76
77
78
    uhEl.resize(nSystems);
    uhNeigh.resize(nSystems);
    if (timestep)
      uhOldEl.resize(nSystems);
79

Thomas Witkowski's avatar
Thomas Witkowski committed
80
    for (int system = 0; system < nSystems; system++) {
81
82
      uhEl[system].change_dim(basFcts[system]->getNumber()); 
      uhNeigh[system].change_dim(basFcts[system]->getNumber());
83
      if (timestep)
84
	uhOldEl[system].change_dim(basFcts[system]->getNumber());
85
86
    }

87
88
89
90
    if (timestep) {
      uhQP.change_dim(nPoints);
      uhOldQP.change_dim(nPoints);
    }
91
    riq = new double[nPoints];
92
93
94
    grdUh_qp = NULL;
    D2uhqp = NULL;

95
    // clear error indicators and mark elements for jumpRes
96
97
    TraverseStack stack;
    ElInfo *elInfo = stack.traverseFirst(mesh, -1, Mesh::CALL_LEAF_EL);
98
99
100
101
102
103
104
105
106
107
    while (elInfo) {
      elInfo->getElement()->setEstimation(0.0, row);
      elInfo->getElement()->setMark(1);
      elInfo = stack.traverseNext(elInfo);
    }

    est_sum = 0.0;
    est_max = 0.0;
    est_t_sum = 0.0;
    est_t_max = 0.0;
108

109
    traverseFlag = 
110
111
112
113
114
115
      Mesh::FILL_NEIGH      |
      Mesh::FILL_COORDS     |
      Mesh::FILL_OPP_COORDS |
      Mesh::FILL_BOUND      |
      Mesh::FILL_GRD_LAMBDA |
      Mesh::FILL_DET        |
116
      Mesh::CALL_LEAF_EL;
117
118
    neighInfo = mesh->createNewElInfo();

119
    // === Prepare date for computing jump residual. ===
120
121
122
123
124
125
126
127
128
129
    if (C1 > 0.0 && dim > 1) {
      surfaceQuad = Quadrature::provideQuadrature(dim - 1, degree);
      nPointsSurface = surfaceQuad->getNumPoints();
      grdUhEl.resize(nPointsSurface);
      grdUhNeigh.resize(nPointsSurface);
      jump.resize(nPointsSurface);
      localJump.resize(nPointsSurface);
      nNeighbours = Global::getGeo(NEIGH, dim);
      lambdaNeigh = new DimVec<WorldVector<double> >(dim, NO_INIT);
      lambda = new DimVec<double>(dim, NO_INIT);
130
131
132
133
134

      secondOrderTerms.resize(nSystems);
      for (int system = 0; system < nSystems; system++) {
	secondOrderTerms[system] = false;

135
136
137
	if (matrix[system] == NULL)
	  continue;

138
139
140
141
	for (std::vector<Operator*>::iterator it = matrix[system]->getOperators().begin();
	     it != matrix[system]->getOperators().end(); ++it)
	  secondOrderTerms[system] = secondOrderTerms[system] || (*it)->secondOrderTerms();
      }
142
    }
143
144
  }

145

146
147
148
149
  void ResidualEstimator::exit(bool output)
  {
    FUNCNAME("ResidualEstimator::exit()");

150
151
152
153
154
155
156
157
158
159
160
161
#ifdef HAVE_PARALLEL_DOMAIN_AMDIS
    double send_est_sum = est_sum;
    double send_est_max = est_max;
    double send_est_t_sum = est_t_sum;
    double send_est_t_max = est_t_max;

    MPI::COMM_WORLD.Allreduce(&send_est_sum, &est_sum, 1, MPI_DOUBLE, MPI_SUM);
    MPI::COMM_WORLD.Allreduce(&send_est_max, &est_max, 1, MPI_DOUBLE, MPI_MAX);
    MPI::COMM_WORLD.Allreduce(&send_est_t_sum, &est_t_sum, 1, MPI_DOUBLE, MPI_SUM);
    MPI::COMM_WORLD.Allreduce(&send_est_t_max, &est_t_max, 1, MPI_DOUBLE, MPI_MAX);
#endif

162
163
164
165
    est_sum = sqrt(est_sum);
    est_t_sum = sqrt(est_t_sum);

    if (output) {
166
      MSG("estimate for component %d = %.8e\n", row, est_sum);
167
      if (C3)
168
	MSG("time estimate for component %d = %.8e\n", row, est_t_sum);
169
170
    }

171
172
173
    delete [] riq;
    delete [] basFcts;
    delete [] quadFast;
174

175
176
177
178
    if (grdUh_qp != NULL)
      delete [] grdUh_qp;
    if (D2uhqp != NULL)
      delete [] D2uhqp;
179

180
    if (C1 && (dim > 1)) {
181
182
      delete lambdaNeigh;
      delete lambda;
183
184
    }

Thomas Witkowski's avatar
Thomas Witkowski committed
185
    delete neighInfo;
186
187
  }

188

189
  void ResidualEstimator::estimateElement(ElInfo *elInfo, DualElInfo *dualElInfo)
190
  {    
191
192
    FUNCNAME("ResidualEstimator::estimateElement()");

Thomas Witkowski's avatar
Thomas Witkowski committed
193
    TEST_EXIT_DBG(nSystems > 0)("no system set\n");
194

Thomas Witkowski's avatar
Thomas Witkowski committed
195
196
    Element *el = elInfo->getElement();
    double est_el = el->getEstimation(row);
197
198
    std::vector<Operator*>::iterator it;
    std::vector<double*>::iterator itfac;
199

200
    // === Init assemblers. ===
Thomas Witkowski's avatar
Thomas Witkowski committed
201
    for (int system = 0; system < nSystems; system++) {
202
203
204
      if (matrix[system] == NULL) 
	continue;

205
206
207
208
209
      DOFMatrix *dofMat = const_cast<DOFMatrix*>(matrix[system]);
      DOFVector<double> *dofVec = const_cast<DOFVector<double>*>(fh[system]);

      for (it = dofMat->getOperatorsBegin(), itfac = dofMat->getOperatorEstFactorBegin();
	   it != dofMat->getOperatorsEnd(); ++it, ++itfac)
210
211
212
213
214
215
216
	if (*itfac == NULL || **itfac != 0.0) {	  
	  // If the estimator must only compute the jump residual but there are no
	  // second order terms in the operator, it can be skipped.
	  if (jumpResidualOnly && (*it)->secondOrderTerms() == false)
	    continue;
	  
	  if (dualElInfo)
217
218
219
	    (*it)->getAssembler(omp_get_thread_num())->initElement(dualElInfo->smallElInfo, 
								   dualElInfo->largeElInfo,
								   quad);
220
221
	  else
	    (*it)->getAssembler(omp_get_thread_num())->initElement(elInfo, NULL, quad);	  
222
	}
223

224
      if (C0 > 0.0)
225
	for (it = dofVec->getOperatorsBegin(); it != dofVec->getOperatorsEnd(); ++it) {
226
	  if (dualElInfo)
227
228
229
	    (*it)->getAssembler(omp_get_thread_num())->initElement(dualElInfo->smallElInfo, 
								   dualElInfo->largeElInfo,
								   quad);
230
231
	  else
	    (*it)->getAssembler(omp_get_thread_num())->initElement(elInfo, NULL, quad);	  
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
    }


    // === Compute element residuals and time error estimation. ===
    if (C0 || C3)
      est_el += computeElementResidual(elInfo, dualElInfo);

    // === Compute jump residuals. ===
    if (C1 && dim > 1)
      est_el += computeJumpResidual(elInfo, dualElInfo);

    // === Update global residual variables. ===
    el->setEstimation(est_el, row);
    el->setMark(0);
    est_sum += est_el;
    est_max = max(est_max, est_el);
  }


  double ResidualEstimator::computeElementResidual(ElInfo *elInfo, 
						   DualElInfo *dualElInfo)
  {
    FUNCNAME("ResidualEstimator::computeElementResidual()");

257
    TEST_EXIT(!dualElInfo)("Not yet implemented!\n");
258
259
260
261
262
263
264
265
266
267
268
269
270

    std::vector<Operator*>::iterator it;
    std::vector<double*>::iterator itfac;
    double det = elInfo->getDet();
    double h2 = h2_from_det(det, dim);

    for (int iq = 0; iq < nPoints; iq++)
      riq[iq] = 0.0;

    for (int system = 0; system < nSystems; system++) {
      if (matrix[system] == NULL) 
	continue;

271
      if (timestep && uhOld[system]) {
272
	TEST_EXIT_DBG(uhOld[system])("no uhOld\n");
273
	uhOld[system]->getLocalVector(elInfo->getElement(), uhOldEl[system]);
274
  
275
276
277
	// === Compute time error. ===

	if (C0 > 0.0 || C3 > 0.0) {   
278
279
280
	  uh[system]->getVecAtQPs(elInfo, NULL, quadFast[system], uhQP);
	  uhOld[system]->getVecAtQPs(elInfo, NULL, quadFast[system], uhOldQP);
	  
281
	  if (C3 > 0.0 && system == std::max(row, 0)) {
282
	    double result = 0.0;
Thomas Witkowski's avatar
Thomas Witkowski committed
283
	    for (int iq = 0; iq < nPoints; iq++) {
284
	      double tiq = (uhQP[iq] - uhOldQP[iq]);
285
	      result += quad->getWeight(iq) * tiq * tiq;
286
	    }
287
	    double v = C3 * det * result;
288
289
290
291
292
	    est_t_sum += v;
	    est_t_max = max(est_t_max, v);
	  }
	}
      }
293
           
294
      // === Compute element residual. ===
295
296
297
298
      if (C0 > 0.0) {
	DOFMatrix *dofMat = const_cast<DOFMatrix*>(matrix[system]);
	DOFVector<double> *dofVec = const_cast<DOFVector<double>*>(fh[system]);
  
Thomas Witkowski's avatar
Thomas Witkowski committed
299
	for (it = dofMat->getOperatorsBegin(), itfac = dofMat->getOperatorEstFactorBegin();
300
	     it != dofMat->getOperatorsEnd();  ++it, ++itfac) {
301
	  if (*itfac == NULL || **itfac != 0.0) {
302
303
	    if (num_rows(uhQP) == 0 && (*it)->zeroOrderTerms()) {
	      uhQP.change_dim(nPoints);
304
305
	      uh[system]->getVecAtQPs(elInfo, NULL, quadFast[system], uhQP);
	    }
306
307
	    if (grdUh_qp == NULL && 
		((*it)->firstOrderTermsGrdPsi() || (*it)->firstOrderTermsGrdPhi())) {
308
309
310
	      grdUh_qp = new WorldVector<double>[nPoints];
	      uh[system]->getGrdAtQPs(elInfo, NULL, quadFast[system], grdUh_qp);
	    }
311
	    if (D2uhqp == NULL && degree > 2 && (*it)->secondOrderTerms()) { 
312
313
314
	      D2uhqp = new WorldMatrix<double>[nPoints];
	      uh[system]->getD2AtQPs(elInfo, NULL, quadFast[system], D2uhqp);	    
	    }
315
316
317
	  }
	}
	
318
319
	// === Compute the element residual and store it in irq. ===

320
	r(elInfo,
Thomas Witkowski's avatar
Thomas Witkowski committed
321
	  nPoints, 
322
323
324
325
326
327
	  uhQP,
	  grdUh_qp,
	  D2uhqp,
	  uhOldQP,
	  NULL,  // grdUhOldQP 
	  NULL,  // D2UhOldQP
Thomas Witkowski's avatar
Thomas Witkowski committed
328
329
	  dofMat, 
	  dofVec,
330
	  quad,
331
	  riq);
332
333
334
335
      }     
    }

    // add integral over r square
336
    double result = 0.0;
337
    for (int iq = 0; iq < nPoints; iq++)
338
      result += quad->getWeight(iq) * riq[iq] * riq[iq];
339
   
340
    if (timestep != 0.0 || norm == NO_NORM || norm == L2_NORM)
341
      result = C0 * h2 * h2 * det * result;
342
    else
343
      result = C0 * h2 * det * result;
344
    
345
346
    return result;
  }
347

348

349
350
351
352
353
354
355
356
357
358
359
  double ResidualEstimator::computeJumpResidual(ElInfo *elInfo, 
						DualElInfo *dualElInfo)
  {
    FUNCNAME("ResidualEstimator::computeJumpResidual()");

    double result = 0.0;
    int dow = Global::getGeo(WORLD);
    Element *el = elInfo->getElement();
    const DimVec<WorldVector<double> > &grdLambda = elInfo->getGrdLambda();
    double det = elInfo->getDet();
    double h2 = h2_from_det(det, dim);
360

361
362
    for (int face = 0; face < nNeighbours; face++) {  
      Element *neigh = const_cast<Element*>(elInfo->getNeighbour(face));
363

364
365
366
367
      if (dualElInfo) {
	int smallFace = DualTraverse::getFace(dualElInfo, face);
      }

368
369
      if (!(neigh && neigh->getMark()))
	continue;
370

371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
      int oppV = elInfo->getOppVertex(face);
	
      el->sortFaceIndices(face, &faceIndEl);
      neigh->sortFaceIndices(oppV, &faceIndNeigh);	
      neighInfo->setElement(const_cast<Element*>(neigh));
      neighInfo->setFillFlag(Mesh::FILL_COORDS);
      
      for (int i = 0; i < dow; i++)
	neighInfo->getCoord(oppV)[i] = elInfo->getOppCoord(face)[i];
      
      // periodic leaf data ?
      ElementData *ldp = el->getElementData()->getElementData(PERIODIC);	
      bool periodicCoords = false;
      
      if (ldp) {
	typedef std::list<LeafDataPeriodic::PeriodicInfo> PerInfList;
	PerInfList& infoList = dynamic_cast<LeafDataPeriodic*>(ldp)->getInfoList();
	
	for (PerInfList::iterator it = infoList.begin(); it != infoList.end(); ++it) {
	  if (it->elementSide == face) {
391
	    for (int i = 0; i < dim; i++) {
392
393
	      int i1 = faceIndEl[i];
	      int i2 = faceIndNeigh[i];
394
	      
395
396
397
398
	      int j = 0;
	      for (; j < dim; j++)
		if (i1 == el->getVertexOfPosition(INDEX_OF_DIM(dim - 1, dim), face, j))
		  break;
399
	      
400
	      TEST_EXIT_DBG(j != dim)("vertex i1 not on face ???\n");
401
	      
402
	      neighInfo->getCoord(i2) = (*(it->periodicCoords))[j];
403
	    }
404
405
	    periodicCoords = true;
	    break;
406
	  }
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
	}
      }  // if (ldp)
      
      if (!periodicCoords) {
	for (int i = 0; i < dim; i++) {
	  int i1 = faceIndEl[i];
	  int i2 = faceIndNeigh[i];
	  for (int j = 0; j < dow; j++)
	    neighInfo->getCoord(i2)[j] = elInfo->getCoord(i1)[j];
	}
      }
	
      Parametric *parametric = mesh->getParametric();
      if (parametric)
	neighInfo = parametric->addParametricInfo(neighInfo);	  
422

423
424
425
426
427
428
429
430
      double detNeigh = abs(neighInfo->calcGrdLambda(*lambdaNeigh));
           
      for (int iq = 0; iq < nPointsSurface; iq++)
	jump[iq].set(0.0);     
      
      for (int system = 0; system < nSystems; system++) {
	if (matrix[system] == NULL || secondOrderTerms[system] == false) 
	  continue;
431
	      
432
	uh[system]->getLocalVector(el, uhEl[system]);	
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
	uh[system]->getLocalVector(neigh, uhNeigh[system]);
	  
	for (int iq = 0; iq < nPointsSurface; iq++) {
	  (*lambda)[face] = 0.0;
	  for (int i = 0; i < dim; i++)
	    (*lambda)[faceIndEl[i]] = surfaceQuad->getLambda(iq, i);
	  
	  basFcts[system]->evalGrdUh(*lambda, grdLambda, uhEl[system], &grdUhEl[iq]);
	  
	  (*lambda)[oppV] = 0.0;
	  for (int i = 0; i < dim; i++)
	    (*lambda)[faceIndNeigh[i]] = surfaceQuad->getLambda(iq, i);		  
	  
	  basFcts[system]->evalGrdUh(*lambda, *lambdaNeigh, uhNeigh[system], &grdUhNeigh[iq]);
	  
	  grdUhEl[iq] -= grdUhNeigh[iq];
	} // for iq				
	
	std::vector<double*>::iterator fac;
	std::vector<Operator*>::iterator it;
	DOFMatrix *mat = const_cast<DOFMatrix*>(matrix[system]);
        for (it = mat->getOperatorsBegin(), fac = mat->getOperatorEstFactorBegin(); 
	     it != mat->getOperatorsEnd(); ++it, ++fac) {
	
	  if (*fac == NULL || **fac != 0.0) {
	    for (int iq = 0; iq < nPointsSurface; iq++)
	      localJump[iq].set(0.0);
	    
461
	    (*it)->weakEvalSecondOrder(grdUhEl, localJump);
462

463
464
465
466
467
468
469
470
471
472
473
474
475
476
	    double factor = *fac ? **fac : 1.0;
	    if (factor != 1.0)
	      for (int i = 0; i < nPointsSurface; i++)
		localJump[i] *= factor;
	    
	    for (int i = 0; i < nPointsSurface; i++)
	      jump[i] += localJump[i];
	  }		
	} // for (it = ...
      } // for system
    
      double val = 0.0;
      for (int iq = 0; iq < nPointsSurface; iq++)
	val += surfaceQuad->getWeight(iq) * (jump[iq] * jump[iq]);
Thomas Witkowski's avatar
Thomas Witkowski committed
477

478
479
      double d = 0.5 * (det + detNeigh);
   
480
      if (norm == NO_NORM || norm == L2_NORM)
481
	val *= C1 * h2_from_det(d, dim) * d;
482
      else
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
	val *= C1 * d;
      
      if (parametric)
	neighInfo = parametric->removeParametricInfo(neighInfo);
      
      neigh->setEstimation(neigh->getEstimation(row) + val, row);
      result += val;
    } // for face
    
    double val = fh[std::max(row, 0)]->getBoundaryManager()->
      boundResidual(elInfo, matrix[std::max(row, 0)], uh[std::max(row, 0)]);    
    if (norm == NO_NORM || norm == L2_NORM)
      val *= C1 * h2;
    else
      val *= C1;   
    result += val;
499

500
    return result;
501
502
  }

Thomas Witkowski's avatar
Thomas Witkowski committed
503

504
  void r(const ElInfo *elInfo,
Thomas Witkowski's avatar
Thomas Witkowski committed
505
	 int nPoints,
506
	 const ElementVector& uhIq,
507
508
	 const WorldVector<double> *grdUhIq,
	 const WorldMatrix<double> *D2UhIq,
509
	 const ElementVector& uhOldIq,
510
511
512
513
514
515
516
	 const WorldVector<double> *grdUhOldIq,
	 const WorldMatrix<double> *D2UhOldIq,
	 DOFMatrix *A, 
	 DOFVector<double> *fh,
	 Quadrature *quad,
	 double *result)
  {
517
518
    std::vector<Operator*>::iterator it;
    std::vector<double*>::iterator fac;
519
520

    // lhs
Thomas Witkowski's avatar
Thomas Witkowski committed
521
522
    for (it = A->getOperatorsBegin(), fac = A->getOperatorEstFactorBegin(); 
	 it != A->getOperatorsEnd(); ++it, ++fac) {
523
524
525
     
      double factor = *fac ? **fac : 1.0;

526
      if (factor) {
Thomas Witkowski's avatar
Thomas Witkowski committed
527
528
	if (D2UhIq)
	  (*it)->evalSecondOrder(nPoints, uhIq, grdUhIq, D2UhIq, result, -factor);	
529
530

	if (grdUhIq) {
Thomas Witkowski's avatar
Thomas Witkowski committed
531
532
	  (*it)->evalFirstOrderGrdPsi(nPoints, uhIq, grdUhIq, D2UhIq, result, factor);
	  (*it)->evalFirstOrderGrdPhi(nPoints, uhIq, grdUhIq, D2UhIq, result, factor);
533
534
	}
	
535
	if (num_rows(uhIq) > 0)
Thomas Witkowski's avatar
Thomas Witkowski committed
536
	  (*it)->evalZeroOrder(nPoints, uhIq, grdUhIq, D2UhIq, result, factor);	
537
538
539
540
      }
    }
    
    // rhs
Thomas Witkowski's avatar
Thomas Witkowski committed
541
542
    for (it = fh->getOperatorsBegin(), fac = fh->getOperatorEstFactorBegin(); 
	 it != fh->getOperatorsEnd(); ++it, ++fac) {
543

544
545
      double factor = *fac ? **fac : 1.0;

546
547
      if (factor) {
	if ((*it)->getUhOld()) {
Thomas Witkowski's avatar
Thomas Witkowski committed
548
549
550
	  if (D2UhOldIq)
	    (*it)->evalSecondOrder(nPoints, uhOldIq, grdUhOldIq, D2UhOldIq, result, factor);
	  
551
	  if (grdUhOldIq) {
Thomas Witkowski's avatar
Thomas Witkowski committed
552
553
	    (*it)->evalFirstOrderGrdPsi(nPoints, uhOldIq, grdUhOldIq, D2UhOldIq, result, -factor);
	    (*it)->evalFirstOrderGrdPhi(nPoints, uhOldIq, grdUhOldIq, D2UhOldIq, result, -factor);
554
	  }
Thomas Witkowski's avatar
Thomas Witkowski committed
555

556
	  if (num_rows(uhOldIq) > 0)
Thomas Witkowski's avatar
Thomas Witkowski committed
557
	    (*it)->evalZeroOrder(nPoints, uhOldIq, grdUhOldIq, D2UhOldIq, result, -factor);	  
558
	} else {
559
	  std::vector<double> fx(nPoints, 0.0);
Thomas Witkowski's avatar
Thomas Witkowski committed
560
	  (*it)->getC(elInfo, nPoints, fx);
561

562
	  for (int iq = 0; iq < nPoints; iq++)
563
564
565
566
567
568
569
570
	    result[iq] -= factor * fx[iq];
	}
      }
    }    
  }


}