PetscSolverFeti.cc 78.3 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12
//
// Software License for AMDiS
//
// Copyright (c) 2010 Dresden University of Technology 
// All rights reserved.
// Authors: Simon Vey, Thomas Witkowski et al.
//
// This file is part of AMDiS
//
// See also license.opensource.txt in the distribution.


13
#include "AMDiS.h"
Thomas Witkowski's avatar
Thomas Witkowski committed
14
#include "MatrixVector.h"
15
#include "parallel/PetscHelper.h"
16
#include "parallel/PetscSolverFeti.h"
17 18
#include "parallel/PetscSolverFetiDebug.h"
#include "parallel/PetscSolverFetiMonitor.h"
19
#include "parallel/PetscSolverFetiStructs.h"
20 21
#include "parallel/PetscSolverFetiOperators.h"
#include "parallel/PetscSolverFetiTimings.h"
22 23
#include "parallel/StdMpi.h"
#include "parallel/MpiHelper.h"
24
#include "parallel/PetscSolverGlobalMatrix.h"
25
#include "io/VtkWriter.h"
26 27 28 29 30

namespace AMDiS {

  using namespace std;

31 32
  PetscSolverFeti::PetscSolverFeti()
    : PetscSolver(),
33 34 35 36 37 38
      primalDofMap(COMPONENT_WISE),
      dualDofMap(COMPONENT_WISE),
      interfaceDofMap(COMPONENT_WISE),
      localDofMap(COMPONENT_WISE),
      lagrangeMap(COMPONENT_WISE),
      interiorDofMap(COMPONENT_WISE),
39
      schurPrimalSolver(0),
40
      multiLevelTest(false),
Thomas Witkowski's avatar
Thomas Witkowski committed
41
      subdomain(NULL),
42
      massMatrixSolver(NULL),
43 44
      meshLevel(0),
      rStartInterior(0),
Thomas Witkowski's avatar
Thomas Witkowski committed
45
      nGlobalOverallInterior(0),
Thomas Witkowski's avatar
Thomas Witkowski committed
46
      printTimings(false),
Thomas Witkowski's avatar
Thomas Witkowski committed
47
      stokesMode(false),
48
      augmentedLagrange(false),
Thomas Witkowski's avatar
Thomas Witkowski committed
49
      pressureComponent(-1)
50 51 52 53 54 55
  {
    FUNCNAME("PetscSolverFeti::PetscSolverFeti()");

    string preconditionerName = "";
    Parameters::get("parallel->solver->precon", preconditionerName);
    if (preconditionerName == "" || preconditionerName == "none") {
56
      MSG("Create FETI-DP solver with no preconditioner!\n");
57 58
      fetiPreconditioner = FETI_NONE;
    } else if (preconditionerName == "dirichlet") {
59
      MSG("Create FETI-DP solver with Dirichlet preconditioner!\n");
60 61
      fetiPreconditioner = FETI_DIRICHLET;
    } else if (preconditionerName == "lumped") {
62
      MSG("Create FETI-DP solver with lumped preconditioner!\n");
63 64
      fetiPreconditioner = FETI_LUMPED;
    } else {
Thomas Witkowski's avatar
Thomas Witkowski committed
65 66
      ERROR_EXIT("Preconditioner \"%s\" not available!\n", 
		 preconditionerName.c_str());
67
    }
Thomas Witkowski's avatar
Thomas Witkowski committed
68 69 70 71 72

    Parameters::get("parallel->feti->schur primal solver", schurPrimalSolver);
    TEST_EXIT(schurPrimalSolver == 0 || schurPrimalSolver == 1)
      ("Wrong solver \"%d\"for the Schur primal complement!\n", 
       schurPrimalSolver);
73 74

    Parameters::get("parallel->multi level test", multiLevelTest);
75 76
    if (multiLevelTest)
      meshLevel = 1;
Thomas Witkowski's avatar
Thomas Witkowski committed
77 78

    Parameters::get("parallel->print timings", printTimings);
79 80

    Parameters::get("parallel->feti->augmented lagrange", augmentedLagrange);
81 82

    Parameters::get("parallel->feti->symmetric", isSymmetric);
83 84 85
  }


86
  void PetscSolverFeti::initialize(vector<const FiniteElemSpace*> feSpaces)
87
  {
88 89
    FUNCNAME("PetscSolverFeti::initialize()");

90 91 92
    TEST_EXIT_DBG(meshLevel + 1 == meshDistributor->getMeshLevelData().getLevelNumber())
      ("Mesh hierarchy does not contain %d levels!\n", meshLevel + 1);

93
    MeshLevelData& levelData = meshDistributor->getMeshLevelData();
94
    vector<const FiniteElemSpace*>& uniqueFe = meshDistributor->getFeSpaces();
95

Thomas Witkowski's avatar
Thomas Witkowski committed
96

Thomas Witkowski's avatar
Thomas Witkowski committed
97 98 99 100 101 102 103 104
    stokesMode = false;
    Parameters::get("parallel->feti->stokes mode", stokesMode);
    if (stokesMode) {
      Parameters::get("parallel->feti->pressure component", pressureComponent);
      TEST_EXIT(pressureComponent >= 0)
	("FETI-DP in Stokes mode, no pressure component defined!\n");

      pressureFeSpace = feSpaces[pressureComponent];
Thomas Witkowski's avatar
Thomas Witkowski committed
105 106
    }
			   
Thomas Witkowski's avatar
Thomas Witkowski committed
107 108
    if (subdomain == NULL) {
      subdomain = new PetscSolverGlobalMatrix();
109
      subdomain->setSymmetric(isSymmetric);
110
      subdomain->setHandleDirichletRows(false);
111

112
      if (meshLevel == 0) {
Thomas Witkowski's avatar
Thomas Witkowski committed
113
	subdomain->setMeshDistributor(meshDistributor, 
114
				      mpiCommGlobal, mpiCommLocal);
115
      } else {
Thomas Witkowski's avatar
Thomas Witkowski committed
116
	subdomain->setMeshDistributor(meshDistributor, 
117 118
				      levelData.getMpiComm(meshLevel - 1),
				      levelData.getMpiComm(meshLevel));
Thomas Witkowski's avatar
Thomas Witkowski committed
119
	subdomain->setLevel(meshLevel);
120 121
      }
    }
122

123 124 125 126
    primalDofMap.init(levelData, feSpaces, uniqueFe);   
    dualDofMap.init(levelData, feSpaces, uniqueFe, false);
    localDofMap.init(levelData, feSpaces, uniqueFe, meshLevel != 0);
    lagrangeMap.init(levelData, feSpaces, uniqueFe);
Thomas Witkowski's avatar
Thomas Witkowski committed
127

Thomas Witkowski's avatar
Thomas Witkowski committed
128
    if (stokesMode)
Thomas Witkowski's avatar
Thomas Witkowski committed
129
      interfaceDofMap.init(levelData, feSpaces, uniqueFe);
Thomas Witkowski's avatar
Thomas Witkowski committed
130

131
    if (fetiPreconditioner == FETI_DIRICHLET) {
132 133 134
      TEST_EXIT(meshLevel == 0)
	("Dirichlet preconditioner not yet implemented for multilevel FETI-DP\n");

135
      interiorDofMap.init(levelData, feSpaces, uniqueFe, false);
136
    }
137 138 139
  }


Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
140 141 142 143 144 145 146 147 148 149 150 151 152
  void PetscSolverFeti::createDirichletData(Matrix<DOFMatrix*> &mat)
  {
    FUNCNAME("PetscSolverFeti::createDirichletData()");

    int nComponents = mat.getSize();
    for (int i = 0; i < nComponents; i++) {
      DOFMatrix* dofMat = mat[i][i];
      if (!dofMat)
	continue;
      
      const FiniteElemSpace *feSpace = dofMat->getRowFeSpace();
      std::set<DegreeOfFreedom>& dRows = dofMat->getDirichletRows();
      if (dirichletRows.count(feSpace)) {
153 154 155 156 157 158 159 160 161
	// === Run test if Dirichlet rows are all the same in all components ===
	// === of one FE space.                                              ===
	TEST_EXIT(dirichletRows[feSpace].size() == dRows.size())
	  ("Wrong number of dirichlet rows!\n");
	
	for (std::set<DegreeOfFreedom>::iterator it0 = dirichletRows[feSpace].begin(),
	       it1 = dRows.begin(); it1 != dRows.end(); ++it0, ++it1) {
	  TEST_EXIT(*it0 == *it1)("Wrong DOFs %d %d!\n", *it0, *it1);
	}
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
162 163 164 165 166 167 168
      } else {
	dirichletRows[feSpace] = dRows;
      }
    }
  }


169 170 171 172
  void PetscSolverFeti::createFetiData()
  {
    FUNCNAME("PetscSolverFeti::createFetiData()");

Thomas Witkowski's avatar
Thomas Witkowski committed
173 174
    double timeCounter = MPI::Wtime();

175 176 177
    TEST_EXIT(meshDistributor)("No mesh distributor object defined!\n");
    TEST_EXIT(meshDistributor->getFeSpaces().size() > 0)
      ("No FE space defined in mesh distributor!\n");
178

179 180
    MeshLevelData& levelData = meshDistributor->getMeshLevelData();

181 182 183 184
    primalDofMap.clear();
    dualDofMap.clear();
    lagrangeMap.clear();
    localDofMap.clear();
185
    if (fetiPreconditioner == FETI_DIRICHLET)
186 187
      interiorDofMap.clear();

188 189
    primalDofMap.setDofComm(meshDistributor->getDofComm());
    lagrangeMap.setDofComm(meshDistributor->getDofComm());
190

191 192
    primalDofMap.setMpiComm(levelData.getMpiComm(0), 0);
    dualDofMap.setMpiComm(levelData.getMpiComm(0), 0);
193
    lagrangeMap.setMpiComm(levelData.getMpiComm(0), 0);
194
    localDofMap.setMpiComm(levelData.getMpiComm(meshLevel), meshLevel);
195
    if (fetiPreconditioner == FETI_DIRICHLET)
196
      interiorDofMap.setMpiComm(levelData.getMpiComm(meshLevel), meshLevel);
197

198 199 200
    if (meshLevel == 0)
      localDofMap.setDofComm(meshDistributor->getDofComm());
    else
201 202
      localDofMap.setDofComm(meshDistributor->getDofCommSd());

Thomas Witkowski's avatar
Thomas Witkowski committed
203
    if (stokesMode) {
204 205 206 207 208
      interfaceDofMap.clear();
      interfaceDofMap.setDofComm(meshDistributor->getDofComm());
      interfaceDofMap.setMpiComm(levelData.getMpiComm(0), 0);
    }

Thomas Witkowski's avatar
Thomas Witkowski committed
209 210
    for (unsigned int i = 0; i < meshDistributor->getComponentFeSpaces().size(); i++) {
      const FiniteElemSpace *feSpace = meshDistributor->getComponentFeSpace(i);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
211
    
Thomas Witkowski's avatar
Thomas Witkowski committed
212
      createPrimals(i, feSpace);  
213

Thomas Witkowski's avatar
Thomas Witkowski committed
214
      createDuals(i, feSpace);
215

Thomas Witkowski's avatar
Thomas Witkowski committed
216
      createInterfaceNodes(i, feSpace);
217

Thomas Witkowski's avatar
Thomas Witkowski committed
218
      createIndexB(i, feSpace);     
219
    }
Thomas Witkowski's avatar
Thomas Witkowski committed
220 221 222 223

    primalDofMap.update();
    dualDofMap.update();
    localDofMap.update();
224
    if (fetiPreconditioner == FETI_DIRICHLET)
225
      interiorDofMap.update();
Thomas Witkowski's avatar
Thomas Witkowski committed
226

Thomas Witkowski's avatar
Thomas Witkowski committed
227
    if (stokesMode)
228 229
      interfaceDofMap.update();

Thomas Witkowski's avatar
Thomas Witkowski committed
230 231 232 233
    for (unsigned int i = 0; i < meshDistributor->getComponentFeSpaces().size(); i++) {
      const FiniteElemSpace *feSpace = meshDistributor->getComponentFeSpace(i);
      createLagrange(i, feSpace);
      createAugmentedLagrange(i, feSpace);
234
    }
235

236 237 238
    lagrangeMap.update();


239 240 241 242 243 244 245 246 247 248 249 250
    // === ===

    if (meshLevel == 0) {
      rStartInterior = 0;
      nGlobalOverallInterior = localDofMap.getOverallDofs();
    } else {
      MeshLevelData& levelData = meshDistributor->getMeshLevelData();

      int groupRowsInterior = 0;
      if (levelData.getMpiComm(1).Get_rank() == 0)
	groupRowsInterior = localDofMap.getOverallDofs();

251
      mpi::getDofNumbering(mpiCommGlobal, groupRowsInterior,
252 253 254 255 256 257 258 259 260
			   rStartInterior, nGlobalOverallInterior);

      int tmp = 0;
      if (levelData.getMpiComm(1).Get_rank() == 0)
	tmp = rStartInterior;

      levelData.getMpiComm(1).Allreduce(&tmp, &rStartInterior, 1, MPI_INT, MPI_SUM);
    }

261
    MSG("FETI-DP data created on mesh level %d\n", meshLevel);
262
    for (unsigned int i = 0; i < meshDistributor->getComponentFeSpaces().size(); i++) {
263
      const FiniteElemSpace *feSpace = meshDistributor->getComponentFeSpace(i);
264 265

      MSG("FETI-DP data for %d-ith component (FE space %p):\n", i, feSpace);
Thomas Witkowski's avatar
Thomas Witkowski committed
266

Thomas Witkowski's avatar
Thomas Witkowski committed
267
      if (feSpace == pressureFeSpace) {
Thomas Witkowski's avatar
Thomas Witkowski committed
268
	MSG("  nRankInterface = %d  nOverallInterface = %d\n",
269 270
	    interfaceDofMap[i].nRankDofs, 
	    interfaceDofMap[i].nOverallDofs);
Thomas Witkowski's avatar
Thomas Witkowski committed
271
      } else {
272
	MSG("  nRankPrimals = %d   nLocalPrimals = %d  nOverallPrimals = %d\n", 
273 274 275
	    primalDofMap[i].nRankDofs, 
	    primalDofMap[i].nLocalDofs,
	    primalDofMap[i].nOverallDofs);
Thomas Witkowski's avatar
Thomas Witkowski committed
276 277
	
	MSG("  nRankDuals = %d  nOverallDuals = %d\n",
278 279
	    dualDofMap[i].nRankDofs, 
	    dualDofMap[i].nOverallDofs);
Thomas Witkowski's avatar
Thomas Witkowski committed
280 281
	
	MSG("  nRankLagrange = %d  nOverallLagrange = %d\n",
282 283
	    lagrangeMap[i].nRankDofs, 
	    lagrangeMap[i].nOverallDofs);
Thomas Witkowski's avatar
Thomas Witkowski committed
284
      }
Thomas Witkowski's avatar
Thomas Witkowski committed
285
    }
286

Thomas Witkowski's avatar
Thomas Witkowski committed
287
    subdomain->setDofMapping(&localDofMap);
Thomas Witkowski's avatar
Thomas Witkowski committed
288 289 290
    subdomain->setCoarseSpaceDofMapping(&primalDofMap); 
    if (stokesMode)
      subdomain->setCoarseSpaceDofMapping(&interfaceDofMap, pressureComponent);
Thomas Witkowski's avatar
Thomas Witkowski committed
291 292

    if (printTimings) {
Thomas Witkowski's avatar
BLUB  
Thomas Witkowski committed
293
      MPI::COMM_WORLD.Barrier();
Thomas Witkowski's avatar
Thomas Witkowski committed
294
      timeCounter = MPI::Wtime() - timeCounter;
295
      MSG("FETI-DP timing 01: %.5f seconds (creation of basic data structures)\n", 
Thomas Witkowski's avatar
Thomas Witkowski committed
296 297
	  timeCounter);
    }
298 299 300
  }


Thomas Witkowski's avatar
Thomas Witkowski committed
301 302
  void PetscSolverFeti::createPrimals(int component,
				      const FiniteElemSpace *feSpace)
Thomas Witkowski's avatar
Thomas Witkowski committed
303
  {
304
    FUNCNAME("PetscSolverFeti::createPrimals()");  
305

Thomas Witkowski's avatar
Thomas Witkowski committed
306
    if (feSpace == pressureFeSpace)
307 308
      return;

309 310 311
    // === Define all vertices on the interior boundaries of the macro mesh ===
    // === to be primal variables.                                          ===

Thomas Witkowski's avatar
Thomas Witkowski committed
312
    // Set of DOF indices that are considered to be primal variables.
313
    DofContainerSet& vertices = 
314
      meshDistributor->getBoundaryDofInfo(feSpace, meshLevel).geoDofs[VERTEX];
315 316

    DofIndexSet primals;
317
    for (DofContainerSet::iterator it = vertices.begin(); 
318
	 it != vertices.end(); ++it) {
319
      
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
320 321
      if (dirichletRows[feSpace].count(**it))
	continue;
Thomas Witkowski's avatar
Thomas Witkowski committed
322

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
323 324
      if (meshLevel == 0) {
	primals.insert(**it);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
325
      } else {
326
	double e = 1e-8;
Thomas Witkowski's avatar
Thomas Witkowski committed
327 328 329
	WorldVector<double> c;
	feSpace->getMesh()->getDofIndexCoords(*it, feSpace, c);

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
330 331 332 333 334 335 336
	if (fabs(c[0]) < e || fabs(c[1]) < e ||
	    fabs(c[0] - 25.0) < e || fabs(c[1] - 25.0) < e ||
	    (fabs(c[0] - 12.5) < e && fabs(c[1] - 12.5) < e)) {
	  MSG("PRIMAL COORD %f %f\n", c[0], c[1]);
	  primals.insert(**it);
	}
      }
337
    }
338

339 340 341 342

    // === Calculate the number of primals that are owned by the rank and ===
    // === create local indices of the primals starting at zero.          ===

343
    for (DofIndexSet::iterator it = primals.begin(); it != primals.end(); ++it)
344
      if (meshDistributor->getDofMap()[feSpace].isRankDof(*it)) {
Thomas Witkowski's avatar
Thomas Witkowski committed
345
	primalDofMap[component].insertRankDof(*it);
346
      } else
Thomas Witkowski's avatar
Thomas Witkowski committed
347
  	primalDofMap[component].insertNonRankDof(*it);
348 349 350
  }


Thomas Witkowski's avatar
Thomas Witkowski committed
351 352
  void PetscSolverFeti::createDuals(int component,
				    const FiniteElemSpace *feSpace)
353 354
  {
    FUNCNAME("PetscSolverFeti::createDuals()");
355

Thomas Witkowski's avatar
Thomas Witkowski committed
356
    if (feSpace == pressureFeSpace)
357 358
      return;

359 360 361
    // === Create global index of the dual nodes on each rank. ===

    DofContainer allBoundaryDofs;
362
    meshDistributor->getAllBoundaryDofs(feSpace, meshLevel, allBoundaryDofs);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
363
    
364
    for (DofContainer::iterator it = allBoundaryDofs.begin();
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
365 366 367 368
	 it != allBoundaryDofs.end(); ++it) {
      if (dirichletRows[feSpace].count(**it))
	continue;

Thomas Witkowski's avatar
Thomas Witkowski committed
369
      if (isPrimal(component, **it))
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
370 371 372
	continue;

      if (meshLevel == 0) {
Thomas Witkowski's avatar
Thomas Witkowski committed
373
	dualDofMap[component].insertRankDof(**it);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
374 375
      } else {
	if (meshDistributor->getDofMapSd()[feSpace].isRankDof(**it))
Thomas Witkowski's avatar
Thomas Witkowski committed
376
	  dualDofMap[component].insertRankDof(**it);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
377 378
      }	  
    }
379 380 381
  }

  
Thomas Witkowski's avatar
Thomas Witkowski committed
382 383
  void PetscSolverFeti::createInterfaceNodes(int component,
					     const FiniteElemSpace *feSpace)
384 385 386
  {
    FUNCNAME("PetscSolverFeti::createInterfaceNodes()");

Thomas Witkowski's avatar
Thomas Witkowski committed
387
    if (feSpace != pressureFeSpace)
388 389 390 391 392 393
      return;

    DofContainer allBoundaryDofs;
    meshDistributor->getAllBoundaryDofs(feSpace, meshLevel, allBoundaryDofs);

    for (DofContainer::iterator it = allBoundaryDofs.begin();
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
394 395 396 397
	 it != allBoundaryDofs.end(); ++it) {
      if (dirichletRows[feSpace].count(**it))
	continue;      
      
398
      if (meshDistributor->getDofMap()[feSpace].isRankDof(**it))
Thomas Witkowski's avatar
Thomas Witkowski committed
399
	interfaceDofMap[component].insertRankDof(**it);
400
      else
Thomas Witkowski's avatar
Thomas Witkowski committed
401
	interfaceDofMap[component].insertNonRankDof(**it);      
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
402
    }
403 404 405
  }


Thomas Witkowski's avatar
Thomas Witkowski committed
406 407
  void PetscSolverFeti::createLagrange(int component,
				       const FiniteElemSpace *feSpace)
408 409 410
  {
    FUNCNAME("PetscSolverFeti::createLagrange()");

Thomas Witkowski's avatar
Thomas Witkowski committed
411
    if (feSpace == pressureFeSpace)
412 413
      return;

414 415
    boundaryDofRanks[feSpace].clear();

Thomas Witkowski's avatar
Thomas Witkowski committed
416 417 418
    // Stores for all rank owned communication DOFs, if the counterpart is
    // a rank owned DOF in its subdomain. Thus, the following map stores to
    // each rank number all DOFs that fulfill this requirenment.
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
419
    map<int, std::set<DegreeOfFreedom> > sdRankDofs;
420

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
421
    if (meshLevel > 0) {
422
      StdMpi<vector<int> > stdMpi(mpiCommGlobal);
423 424 425 426 427 428 429 430 431

      for (DofComm::Iterator it(meshDistributor->getDofComm().getRecvDofs(), 
				meshLevel, feSpace);
	   !it.end(); it.nextRank()) {

	vector<int> subdomainRankDofs;
	subdomainRankDofs.reserve(it.getDofs().size());

	for (; !it.endDofIter(); it.nextDof()) {
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
432
	  if (meshDistributor->getDofMapSd()[feSpace].isRankDof(it.getDofIndex()))
433
	    subdomainRankDofs.push_back(1);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
434
	  else
435 436 437 438 439 440 441 442 443 444 445 446 447 448 449
	    subdomainRankDofs.push_back(0);
	}

	stdMpi.send(it.getRank(), subdomainRankDofs);
      }	     

      for (DofComm::Iterator it(meshDistributor->getDofComm().getSendDofs(), 
				meshLevel, feSpace);
	   !it.end(); it.nextRank())
	stdMpi.recv(it.getRank());

      stdMpi.startCommunication();

      for (DofComm::Iterator it(meshDistributor->getDofComm().getSendDofs(), 
				meshLevel, feSpace); 
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
450 451
	   !it.end(); it.nextRank())
	for (; !it.endDofIter(); it.nextDof())
Thomas Witkowski's avatar
Thomas Witkowski committed
452
	  if (!isPrimal(component, it.getDofIndex()))
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
453 454 455
	    if (stdMpi.getRecvData(it.getRank())[it.getDofCounter()] == 1)
	      sdRankDofs[it.getRank()].insert(it.getDofIndex());
    }
456

Thomas Witkowski's avatar
Thomas Witkowski committed
457
    if (dualDofMap[component].nLocalDofs == 0)
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
458 459 460 461 462 463
      return;


    // === Create for each dual node that is owned by the rank, the set ===
    // === of ranks that contain this node (denoted by W(x_j)).         ===

464
    int mpiRank = meshDistributor->getMpiRank();
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
465 466 467 468
    for (DofComm::Iterator it(meshDistributor->getDofComm().getSendDofs(), 
			      meshLevel, feSpace); 
	 !it.end(); it.nextRank()) {
      for (; !it.endDofIter(); it.nextDof()) {
Thomas Witkowski's avatar
Thomas Witkowski committed
469
	if (!isPrimal(component, it.getDofIndex())) {
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
470 471
	  boundaryDofRanks[feSpace][it.getDofIndex()].insert(mpiRank);

472
 	  if (meshLevel == 0 ||
Thomas Witkowski's avatar
Thomas Witkowski committed
473
 	      (meshLevel > 0 && sdRankDofs[it.getRank()].count(it.getDofIndex())))
474
	    boundaryDofRanks[feSpace][it.getDofIndex()].insert(it.getRank());	  
475 476 477 478
	}
      }
    }

479 480 481 482

    // === Communicate these sets for all rank owned dual nodes to other ===
    // === ranks that also have this node.                               ===

483
    StdMpi<vector<std::set<int> > > stdMpi(meshDistributor->getMpiComm());
484

485
    for (DofComm::Iterator it(meshDistributor->getDofComm().getSendDofs(), meshLevel, feSpace);
486 487
	 !it.end(); it.nextRank())
      for (; !it.endDofIter(); it.nextDof())
Thomas Witkowski's avatar
Thomas Witkowski committed
488
	if (!isPrimal(component, it.getDofIndex()))
489 490 491
 	  if (meshLevel == 0 ||
 	      (meshLevel > 0 && sdRankDofs[it.getRank()].count(it.getDofIndex())))
	    stdMpi.getSendData(it.getRank()).push_back(boundaryDofRanks[feSpace][it.getDofIndex()]);
492 493 494

    stdMpi.updateSendDataSize();

495
    for (DofComm::Iterator it(meshDistributor->getDofComm().getRecvDofs(), meshLevel, feSpace); 
496
	 !it.end(); it.nextRank()) {
497
      bool recvFromRank = false;
498
      for (; !it.endDofIter(); it.nextDof()) {
Thomas Witkowski's avatar
Thomas Witkowski committed
499
	if (!isPrimal(component, it.getDofIndex())) {
500 501 502
 	  if (meshLevel == 0 ||
 	      (meshLevel > 0 && 
 	       meshDistributor->getDofMapSd()[feSpace].isRankDof(it.getDofIndex()))) {
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
503 504 505
	    recvFromRank = true;
	    break;
	  }
506
	}
507
      }
508 509

      if (recvFromRank)
510
	stdMpi.recv(it.getRank());
511
    }
512

513 514
    stdMpi.startCommunication();

515
    for (DofComm::Iterator it(meshDistributor->getDofComm().getRecvDofs(), meshLevel, feSpace); 
516
	 !it.end(); it.nextRank()) {
517
      int i = 0;
518
      for (; !it.endDofIter(); it.nextDof())
Thomas Witkowski's avatar
Thomas Witkowski committed
519
	if (!isPrimal(component, it.getDofIndex()))
520 521 522
 	  if (meshLevel == 0 ||
 	      (meshLevel > 0 && 
 	       meshDistributor->getDofMapSd()[feSpace].isRankDof(it.getDofIndex())))	    
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
523 524
	    boundaryDofRanks[feSpace][it.getDofIndex()] = 
	      stdMpi.getRecvData(it.getRank())[i++];
525
	  else
Thomas Witkowski's avatar
Thomas Witkowski committed
526
	    lagrangeMap[component].insertNonRankDof(it.getDofIndex());
527 528
    }

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
529

530 531 532
    // === Reserve for each dual node, on the rank that owns this node, the ===
    // === appropriate number of Lagrange constraints.                      ===

533
    int nRankLagrange = 0;
534
    DofMap& dualMap = dualDofMap[component].getMap();
535
    for (DofMap::iterator it = dualMap.begin(); it != dualMap.end(); ++it) {
536
      if (meshDistributor->getDofMap()[feSpace].isRankDof(it->first)) {
Thomas Witkowski's avatar
Thomas Witkowski committed
537
	lagrangeMap[component].insertRankDof(it->first, nRankLagrange);
538
	int degree = boundaryDofRanks[feSpace][it->first].size();
539
	nRankLagrange += (degree * (degree - 1)) / 2;
Thomas Witkowski's avatar
Thomas Witkowski committed
540
      } else {
Thomas Witkowski's avatar
Thomas Witkowski committed
541
	lagrangeMap[component].insertNonRankDof(it->first);
542 543
      }
    }
Thomas Witkowski's avatar
Thomas Witkowski committed
544
    lagrangeMap[component].nRankDofs = nRankLagrange;
545 546 547
  }


Thomas Witkowski's avatar
Thomas Witkowski committed
548 549
  void PetscSolverFeti::createAugmentedLagrange(int component,
						const FiniteElemSpace *feSpace)
550 551 552 553 554 555 556 557
  {
    FUNCNAME("PetscSolverFeti::createAugmentedLagrange()");

    if (!augmentedLagrange)
      return;
  }


Thomas Witkowski's avatar
Thomas Witkowski committed
558 559
  void PetscSolverFeti::createIndexB(int component,
				     const FiniteElemSpace *feSpace)
560
  {
561
    FUNCNAME("PetscSolverFeti::createIndexB()");
562

563
    DOFAdmin* admin = feSpace->getAdmin();
564 565 566 567

    // === To ensure that all interior node on each rank are listen first in ===
    // === the global index of all B nodes, insert all interior nodes first, ===
    // === without defining a correct index.                                 ===
568

569
    int nLocalInterior = 0;    
570
    for (int i = 0; i < admin->getUsedSize(); i++) {
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
571
      if (admin->isDofFree(i) ||
Thomas Witkowski's avatar
Thomas Witkowski committed
572 573 574
	  isPrimal(component, i) ||
	  isDual(component, i) ||
	  isInterface(component, i) ||
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
575 576
	  dirichletRows[feSpace].count(i))
	continue;      
577

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
578
      if (meshLevel == 0) {
Thomas Witkowski's avatar
Thomas Witkowski committed
579
	localDofMap[component].insertRankDof(i, nLocalInterior);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
580 581
	
	if (fetiPreconditioner == FETI_DIRICHLET)
582
	  interiorDofMap[component].insertRankDof(i, nLocalInterior);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
583 584 585 586
	
	nLocalInterior++;	
      } else {
	if (meshDistributor->getDofMapSd()[feSpace].isRankDof(i))
Thomas Witkowski's avatar
Thomas Witkowski committed
587
	  localDofMap[component].insertRankDof(i);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
588
	else
Thomas Witkowski's avatar
Thomas Witkowski committed
589
	  localDofMap[component].insertNonRankDof(i);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
590 591 592
	
	TEST_EXIT_DBG(fetiPreconditioner == FETI_NONE)
	  ("Not yet implemnted!\n");	
593
      }
594
    }
Thomas Witkowski's avatar
FETI-DP  
Thomas Witkowski committed
595
    
596 597
    // === And finally, add the global indicies of all dual nodes. ===

598 599
    for (DofMap::iterator it = dualDofMap[component].getMap().begin();
	 it != dualDofMap[component].getMap().end(); ++it) {
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
600
      if (meshLevel == 0) {
Thomas Witkowski's avatar
Thomas Witkowski committed
601
	localDofMap[component].insertRankDof(it->first);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
602
      } else {
603
	if (meshDistributor->getDofMapSd()[feSpace].isRankDof(it->first))
Thomas Witkowski's avatar
Thomas Witkowski committed
604
	  localDofMap[component].insertRankDof(it->first);
605
	else 
Thomas Witkowski's avatar
Thomas Witkowski committed
606
	  localDofMap[component].insertNonRankDof(it->first);
607
      }
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
608
    }
609 610 611
  }


612
  void PetscSolverFeti::createMatLagrange(vector<const FiniteElemSpace*> &feSpaces)
613 614 615
  {
    FUNCNAME("PetscSolverFeti::createMatLagrange()");

Thomas Witkowski's avatar
Thomas Witkowski committed
616
    double wtime = MPI::Wtime();
617
    int mpiRank = meshDistributor->getMpiRank();
Thomas Witkowski's avatar
Thomas Witkowski committed
618

619 620
    // === Create distributed matrix for Lagrange constraints. ===

621 622 623 624 625
    MatCreateAIJ(mpiCommGlobal,
		 lagrangeMap.getRankDofs(), localDofMap.getRankDofs(),
		 lagrangeMap.getOverallDofs(), nGlobalOverallInterior,
		 2, PETSC_NULL, 2, PETSC_NULL,
		 &mat_lagrange);
626
    MatSetOption(mat_lagrange, MAT_NEW_NONZERO_ALLOCATION_ERR, PETSC_FALSE);
627

628 629 630
    Vec vec_scale_lagrange;
    lagrangeMap.createVec(vec_scale_lagrange);

631 632 633 634 635 636 637
    // === Create for all duals the corresponding Lagrange constraints. On ===
    // === each rank we traverse all pairs (n, m) of ranks, with n < m,    ===
    // === that contain this node. If the current rank number is r, and    ===
    // === n == r, the rank sets 1.0 for the corresponding constraint, if  ===
    // === m == r, than the rank sets -1.0 for the corresponding           ===
    // === constraint.                                                     ===

638 639
    for (unsigned int component = 0; component < feSpaces.size(); component++) {
      DofMap &dualMap = dualDofMap[component].getMap();
640

641
      for (DofMap::iterator it = dualMap.begin(); it != dualMap.end(); ++it) {
642
	TEST_EXIT_DBG(boundaryDofRanks[feSpaces[component]].count(it->first))
Thomas Witkowski's avatar
Thomas Witkowski committed
643 644 645
	  ("Should not happen!\n");
	
	// Global index of the first Lagrange constriant for this node.
646
	int index = lagrangeMap.getMatIndex(component, it->first);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
647

Thomas Witkowski's avatar
Thomas Witkowski committed
648
	// Copy set of all ranks that contain this dual node.
649 650
	vector<int> W(boundaryDofRanks[feSpaces[component]][it->first].begin(), 
		      boundaryDofRanks[feSpaces[component]][it->first].end());
Thomas Witkowski's avatar
Thomas Witkowski committed
651 652
	// Number of ranks that contain this dual node.
	int degree = W.size();
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
653 654

	TEST_EXIT_DBG(degree > 1)("Should not happen!\n");
Thomas Witkowski's avatar
Thomas Witkowski committed
655
	
656
	int counter = 0;
Thomas Witkowski's avatar
Thomas Witkowski committed
657 658 659
	for (int i = 0; i < degree; i++) {
	  for (int j = i + 1; j < degree; j++) {
	    if (W[i] == mpiRank || W[j] == mpiRank) {
660 661
	      MatSetValue(mat_lagrange, 
			  index + counter, 
662
			  localDofMap.getMatIndex(component, it->first) + rStartInterior,
663 664
			  (W[i] == mpiRank ? 1.0 : -1.0),
			  INSERT_VALUES);
665
	    }
666 667 668 669 670 671 672
	    counter++;
	  }
	}

	// === Create scaling factors for scaling the lagrange matrix, which ===
	// === is required for FETI-DP preconditioners.                      ===
	
673
	if (meshDistributor->getDofMap()[feSpaces[component]].isRankDof(it->first)) {
674 675 676 677 678 679
	  int nConstraints = (degree * (degree - 1)) / 2;
	  for (int i = 0; i < nConstraints; i++) {
	    VecSetValue(vec_scale_lagrange,
			index + i,
			1.0 / static_cast<double>(degree),
			INSERT_VALUES);
680 681 682 683 684 685 686
	  }
	}
      }
    }

    MatAssemblyBegin(mat_lagrange, MAT_FINAL_ASSEMBLY);
    MatAssemblyEnd(mat_lagrange, MAT_FINAL_ASSEMBLY);
Thomas Witkowski's avatar
Thomas Witkowski committed
687

688

Thomas Witkowski's avatar
So on  
Thomas Witkowski committed
689 690 691 692 693 694 695 696 697 698 699 700
    int nZeroRows = PetscSolverFetiDebug::testZeroRows(mat_lagrange);
    int m,n;
    MatGetSize(mat_lagrange, &m ,&n);
    MSG("Lagrange matrix has %d zero rows and global size of %d %d!\n", nZeroRows, m, n);

    PetscViewer petscView;
    PetscViewerBinaryOpen(PETSC_COMM_WORLD, "lagrange.mat", 
			  FILE_MODE_WRITE, &petscView);
    MatView(mat_lagrange, petscView);
    PetscViewerDestroy(&petscView);


701 702 703 704 705 706 707 708 709 710 711 712 713 714 715
    // === If required, create \ref mat_lagrange_scaled ===

    VecAssemblyBegin(vec_scale_lagrange);
    VecAssemblyEnd(vec_scale_lagrange);

    if (fetiPreconditioner != FETI_NONE || stokesMode) {
      MatDuplicate(mat_lagrange, MAT_COPY_VALUES, &mat_lagrange_scaled);
      MatDiagonalScale(mat_lagrange_scaled, vec_scale_lagrange, PETSC_NULL);
    }

    VecDestroy(&vec_scale_lagrange);


    // === Print final timings. ===

Thomas Witkowski's avatar
BLUB  
Thomas Witkowski committed
716 717
    if (printTimings) {
      MPI::COMM_WORLD.Barrier();
Thomas Witkowski's avatar
Thomas Witkowski committed
718 719
      MSG("FETI-DP timing 05: %.5f seconds (creation of lagrange constraint matrix)\n", 
	  MPI::Wtime() - wtime);
Thomas Witkowski's avatar
BLUB  
Thomas Witkowski committed
720
    }
721 722
  }

723

Thomas Witkowski's avatar
Thomas Witkowski committed
724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739
  bool PetscSolverFeti::testWirebasketEdge(BoundaryObject &edge, const FiniteElemSpace *feSpace)
  {
    Element *el = edge.el;
    int i0 = el->getVertexOfEdge(edge.ithObj, 0);
    int i1 = el->getVertexOfEdge(edge.ithObj, 1);
    DegreeOfFreedom d0 = el->getDof(i0, 0);
    DegreeOfFreedom d1 = el->getDof(i1, 0);
    WorldVector<double> c0, c1;
    el->getMesh()->getDofIndexCoords(d0, feSpace, c0);
    el->getMesh()->getDofIndexCoords(d1, feSpace, c1);
    bool xe = fabs(c0[0] - c1[0]) < 1e-8;
    bool ye = fabs(c0[1] - c1[1]) < 1e-8;
    bool ze = fabs(c0[2] - c1[2]) < 1e-8;
    int counter = static_cast<int>(xe) + static_cast<int>(ye) + static_cast<int>(ze);
    return (counter == 2);
  }
740

741

742 743 744 745 746 747 748 749 750 751 752
  void PetscSolverFeti::createMatAugmentedLagrange(vector<const FiniteElemSpace*> &feSpaces)
  {
    FUNCNAME("PetscSolverFeti::createMatAugmentedLagrange()");

    if (!augmentedLagrange)
      return;

    double wtime = MPI::Wtime();

    nOverallEdges = 0;
    InteriorBoundary &intBound = meshDistributor->getIntBoundary();
Thomas Witkowski's avatar
Thomas Witkowski committed
753
    std::set<BoundaryObject> allEdges;
754
    for (InteriorBoundary::iterator it(intBound.getOwn()); !it.end(); ++it) {
755 756 757
      if ((it->rankObj.subObj == FACE ||
	   (it->rankObj.subObj == EDGE && 
	    testWirebasketEdge(it->rankObj, feSpaces[0]))) && 
758 759 760 761 762
	  allEdges.count(it->rankObj) == 0) {
	bool dirichletOnlyEdge = true;

	DofContainer edgeDofs;
	it->rankObj.el->getAllDofs(feSpaces[0], it->rankObj, edgeDofs);
763
	
764 765 766 767 768 769 770 771 772 773 774 775
	for (DofContainer::iterator dit = edgeDofs.begin();
	     dit != edgeDofs.end(); ++dit) {
	  if (dirichletRows[feSpaces[0]].count(**dit) == 0) {
	    dirichletOnlyEdge = false;
	    break;
	  }
	}

	if (!dirichletOnlyEdge)
	  allEdges.insert(it->rankObj);
      }
    }
Thomas Witkowski's avatar
Thomas Witkowski committed
776 777

    nRankEdges = allEdges.size();    
778 779 780 781
    int rStartEdges = 0;
    mpi::getDofNumbering(mpiCommGlobal, nRankEdges, rStartEdges, nOverallEdges);

    MSG("nRankEdges = %d, nOverallEdges = %d\n", nRankEdges, nOverallEdges);
782
    
783 784 785 786 787
    nRankEdges *= feSpaces.size();
    rStartEdges *= feSpaces.size();
    nOverallEdges *= feSpaces.size();

    MatCreateAIJ(mpiCommGlobal,
788 789
		 nRankEdges, lagrangeMap.getRankDofs(),
		 nOverallEdges, lagrangeMap.getOverallDofs(),
790
		 2, PETSC_NULL, 2, PETSC_NULL, 
791 792 793
		 &mat_augmented_lagrange);
    MatSetOption(mat_augmented_lagrange, MAT_NEW_NONZERO_ALLOCATION_ERR, PETSC_FALSE);

794
    int rowCounter = rStartEdges;
Thomas Witkowski's avatar
Thomas Witkowski committed
795 796
    for (std::set<BoundaryObject>::iterator edgeIt = allEdges.begin(); 
	 edgeIt != allEdges.end(); ++edgeIt) {
Thomas Witkowski's avatar
Thomas Witkowski committed
797
      for (int component = 0; component < feSpaces.size(); component++) {
Thomas Witkowski's avatar
Thomas Witkowski committed
798
	DofContainer edgeDofs;
Thomas Witkowski's avatar
Thomas Witkowski committed
799
	edgeIt->el->getAllDofs(feSpaces[component], *edgeIt, edgeDofs);
Thomas Witkowski's avatar
Thomas Witkowski committed
800 801 802
	
	for (DofContainer::iterator it = edgeDofs.begin();
	     it != edgeDofs.end(); ++it) {
Thomas Witkowski's avatar
Thomas Witkowski committed
803
	  TEST_EXIT_DBG(isPrimal(component, **it) == false)
Thomas Witkowski's avatar
Thomas Witkowski committed
804 805
	    ("Should not be primal!\n");
	  
Thomas Witkowski's avatar
Thomas Witkowski committed
806
	  if (dirichletRows[feSpaces[component]].count(**it))
Thomas Witkowski's avatar
Thomas Witkowski committed
807 808
	    continue;
	  
Thomas Witkowski's avatar
Thomas Witkowski committed
809
	  int col = lagrangeMap.getMatIndex(component, **it);
Thomas Witkowski's avatar
Thomas Witkowski committed
810