PetscSolverFeti.cc 78 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
      schurPrimalSolver(0),
34
      multiLevelTest(false),
Thomas Witkowski's avatar
Thomas Witkowski committed
35
      subdomain(NULL),
36
      massMatrixSolver(NULL),
37 38
      meshLevel(0),
      rStartInterior(0),
Thomas Witkowski's avatar
Thomas Witkowski committed
39
      nGlobalOverallInterior(0),
Thomas Witkowski's avatar
Thomas Witkowski committed
40
      printTimings(false),
Thomas Witkowski's avatar
Thomas Witkowski committed
41
      stokesMode(false),
42
      augmentedLagrange(false),
Thomas Witkowski's avatar
Thomas Witkowski committed
43
      pressureComponent(-1)
44 45 46 47 48 49
  {
    FUNCNAME("PetscSolverFeti::PetscSolverFeti()");

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

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

    Parameters::get("parallel->multi level test", multiLevelTest);
69 70
    if (multiLevelTest)
      meshLevel = 1;
Thomas Witkowski's avatar
Thomas Witkowski committed
71 72

    Parameters::get("parallel->print timings", printTimings);
73 74

    Parameters::get("parallel->feti->augmented lagrange", augmentedLagrange);
75 76

    Parameters::get("parallel->feti->symmetric", isSymmetric);
77 78 79
  }


80
  void PetscSolverFeti::initialize(vector<const FiniteElemSpace*> feSpaces)
81
  {
82 83
    FUNCNAME("PetscSolverFeti::initialize()");

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

87
    MeshLevelData& levelData = meshDistributor->getMeshLevelData();
88
    vector<const FiniteElemSpace*>& uniqueFe = meshDistributor->getFeSpaces();
89

Thomas Witkowski's avatar
Thomas Witkowski committed
90

Thomas Witkowski's avatar
Thomas Witkowski committed
91 92 93 94 95 96 97 98
    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
99 100
    }
			   
Thomas Witkowski's avatar
Thomas Witkowski committed
101 102
    if (subdomain == NULL) {
      subdomain = new PetscSolverGlobalMatrix();
103
      subdomain->setSymmetric(isSymmetric);
104
      subdomain->setHandleDirichletRows(false);
105

106
      if (meshLevel == 0) {
Thomas Witkowski's avatar
Thomas Witkowski committed
107
	subdomain->setMeshDistributor(meshDistributor, 
108
				      mpiCommGlobal, mpiCommLocal);
109
      } else {
Thomas Witkowski's avatar
Thomas Witkowski committed
110
	subdomain->setMeshDistributor(meshDistributor, 
111 112
				      levelData.getMpiComm(meshLevel - 1),
				      levelData.getMpiComm(meshLevel));
Thomas Witkowski's avatar
Thomas Witkowski committed
113
	subdomain->setLevel(meshLevel);
114 115
      }
    }
116

117 118 119 120
    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
121

Thomas Witkowski's avatar
Thomas Witkowski committed
122
    if (stokesMode)
Thomas Witkowski's avatar
Thomas Witkowski committed
123
      interfaceDofMap.init(levelData, feSpaces, uniqueFe);
Thomas Witkowski's avatar
Thomas Witkowski committed
124

125
    if (fetiPreconditioner == FETI_DIRICHLET) {
126 127 128
      TEST_EXIT(meshLevel == 0)
	("Dirichlet preconditioner not yet implemented for multilevel FETI-DP\n");

129
      interiorDofMap.init(levelData, feSpaces, uniqueFe, false);
130
    }
131 132 133
  }


Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
134 135 136 137 138 139 140 141 142 143 144 145 146
  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)) {
147 148 149 150 151 152 153 154 155
	// === 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
156 157 158 159 160 161 162
      } else {
	dirichletRows[feSpace] = dRows;
      }
    }
  }


163 164 165 166
  void PetscSolverFeti::createFetiData()
  {
    FUNCNAME("PetscSolverFeti::createFetiData()");

Thomas Witkowski's avatar
Thomas Witkowski committed
167 168
    double timeCounter = MPI::Wtime();

169 170 171
    TEST_EXIT(meshDistributor)("No mesh distributor object defined!\n");
    TEST_EXIT(meshDistributor->getFeSpaces().size() > 0)
      ("No FE space defined in mesh distributor!\n");
172

173 174
    MeshLevelData& levelData = meshDistributor->getMeshLevelData();

175 176 177 178
    primalDofMap.clear();
    dualDofMap.clear();
    lagrangeMap.clear();
    localDofMap.clear();
179
    if (fetiPreconditioner == FETI_DIRICHLET)
180 181
      interiorDofMap.clear();

182 183
    primalDofMap.setDofComm(meshDistributor->getDofComm());
    lagrangeMap.setDofComm(meshDistributor->getDofComm());
184

185 186
    primalDofMap.setMpiComm(levelData.getMpiComm(0), 0);
    dualDofMap.setMpiComm(levelData.getMpiComm(0), 0);
187
    lagrangeMap.setMpiComm(levelData.getMpiComm(0), 0);
188
    localDofMap.setMpiComm(levelData.getMpiComm(meshLevel), meshLevel);
189
    if (fetiPreconditioner == FETI_DIRICHLET)
190
      interiorDofMap.setMpiComm(levelData.getMpiComm(meshLevel), meshLevel);
191

192 193 194
    if (meshLevel == 0)
      localDofMap.setDofComm(meshDistributor->getDofComm());
    else
195 196
      localDofMap.setDofComm(meshDistributor->getDofCommSd());

Thomas Witkowski's avatar
Thomas Witkowski committed
197
    if (stokesMode) {
198 199 200 201 202
      interfaceDofMap.clear();
      interfaceDofMap.setDofComm(meshDistributor->getDofComm());
      interfaceDofMap.setMpiComm(levelData.getMpiComm(0), 0);
    }

Thomas Witkowski's avatar
Thomas Witkowski committed
203 204
    for (unsigned int i = 0; i < meshDistributor->getComponentFeSpaces().size(); i++) {
      const FiniteElemSpace *feSpace = meshDistributor->getComponentFeSpace(i);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
205
    
Thomas Witkowski's avatar
Thomas Witkowski committed
206
      createPrimals(i, feSpace);  
207

Thomas Witkowski's avatar
Thomas Witkowski committed
208
      createDuals(i, feSpace);
209

Thomas Witkowski's avatar
Thomas Witkowski committed
210
      createInterfaceNodes(i, feSpace);
211

Thomas Witkowski's avatar
Thomas Witkowski committed
212
      createIndexB(i, feSpace);     
213
    }
Thomas Witkowski's avatar
Thomas Witkowski committed
214 215 216 217

    primalDofMap.update();
    dualDofMap.update();
    localDofMap.update();
218
    if (fetiPreconditioner == FETI_DIRICHLET)
219
      interiorDofMap.update();
Thomas Witkowski's avatar
Thomas Witkowski committed
220

Thomas Witkowski's avatar
Thomas Witkowski committed
221
    if (stokesMode)
222 223
      interfaceDofMap.update();

Thomas Witkowski's avatar
Thomas Witkowski committed
224 225 226 227
    for (unsigned int i = 0; i < meshDistributor->getComponentFeSpaces().size(); i++) {
      const FiniteElemSpace *feSpace = meshDistributor->getComponentFeSpace(i);
      createLagrange(i, feSpace);
      createAugmentedLagrange(i, feSpace);
228
    }
229

230 231 232
    lagrangeMap.update();


233 234 235 236 237 238 239 240 241 242 243 244
    // === ===

    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();

245
      mpi::getDofNumbering(mpiCommGlobal, groupRowsInterior,
246 247 248 249 250 251 252 253 254
			   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);
    }

255
    MSG("FETI-DP data created on mesh level %d\n", meshLevel);
Thomas Witkowski's avatar
Thomas Witkowski committed
256 257
    for (unsigned int i = 0; i < meshDistributor->getFeSpaces().size(); i++) {
      const FiniteElemSpace *feSpace = meshDistributor->getFeSpace(i);
Thomas Witkowski's avatar
Thomas Witkowski committed
258
      MSG("FETI-DP data for %d-ith FE space: %p\n", i, feSpace);
Thomas Witkowski's avatar
Thomas Witkowski committed
259

Thomas Witkowski's avatar
Thomas Witkowski committed
260
      if (feSpace == pressureFeSpace) {
Thomas Witkowski's avatar
Thomas Witkowski committed
261 262 263 264
	MSG("  nRankInterface = %d  nOverallInterface = %d\n",
	    interfaceDofMap[feSpace].nRankDofs, 
	    interfaceDofMap[feSpace].nOverallDofs);
      } else {
265
	MSG("  nRankPrimals = %d   nLocalPrimals = %d  nOverallPrimals = %d\n", 
Thomas Witkowski's avatar
Thomas Witkowski committed
266
	    primalDofMap[feSpace].nRankDofs, 
267
	    primalDofMap[feSpace].nLocalDofs,
Thomas Witkowski's avatar
Thomas Witkowski committed
268 269 270 271 272 273 274 275 276 277
	    primalDofMap[feSpace].nOverallDofs);
	
	MSG("  nRankDuals = %d  nOverallDuals = %d\n",
	    dualDofMap[feSpace].nRankDofs, 
	    dualDofMap[feSpace].nOverallDofs);
	
	MSG("  nRankLagrange = %d  nOverallLagrange = %d\n",
	    lagrangeMap[feSpace].nRankDofs, 
	    lagrangeMap[feSpace].nOverallDofs);

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
278 279 280
// 	TEST_EXIT_DBG(localDofMap[feSpace].size() + primalDofMap[feSpace].size() == 
// 		      static_cast<unsigned int>(feSpace->getAdmin()->getUsedDofs()))
// 	  ("Should not happen!\n");	
Thomas Witkowski's avatar
Thomas Witkowski committed
281
      }
Thomas Witkowski's avatar
Thomas Witkowski committed
282
    }
283

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

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


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

Thomas Witkowski's avatar
Thomas Witkowski committed
303
    if (feSpace == pressureFeSpace)
304 305
      return;

306 307 308
    // === Define all vertices on the interior boundaries of the macro mesh ===
    // === to be primal variables.                                          ===

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

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

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

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
327 328 329 330 331 332 333
	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);
	}
      }
334
    }
335

336 337 338 339

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

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


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

Thomas Witkowski's avatar
Thomas Witkowski committed
353
    if (feSpace == pressureFeSpace)
354 355
      return;

356 357 358
    // === Create global index of the dual nodes on each rank. ===

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

Thomas Witkowski's avatar
Thomas Witkowski committed
366
      if (isPrimal(component, **it))
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
367 368 369
	continue;

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

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

Thomas Witkowski's avatar
Thomas Witkowski committed
384
    if (feSpace != pressureFeSpace)
385 386 387 388 389 390
      return;

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

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


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

Thomas Witkowski's avatar
Thomas Witkowski committed
408
    if (feSpace == pressureFeSpace)
409 410
      return;

411 412
    boundaryDofRanks[feSpace].clear();

Thomas Witkowski's avatar
Thomas Witkowski committed
413 414 415
    // 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
416
    map<int, std::set<DegreeOfFreedom> > sdRankDofs;
417

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

      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
429
	  if (meshDistributor->getDofMapSd()[feSpace].isRankDof(it.getDofIndex()))
430
	    subdomainRankDofs.push_back(1);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
431
	  else
432 433 434 435 436 437 438 439 440 441 442 443 444 445 446
	    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
447 448
	   !it.end(); it.nextRank())
	for (; !it.endDofIter(); it.nextDof())
Thomas Witkowski's avatar
Thomas Witkowski committed
449
	  if (!isPrimal(component, it.getDofIndex()))
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
450 451 452
	    if (stdMpi.getRecvData(it.getRank())[it.getDofCounter()] == 1)
	      sdRankDofs[it.getRank()].insert(it.getDofIndex());
    }
453

Thomas Witkowski's avatar
Thomas Witkowski committed
454
    if (dualDofMap[component].nLocalDofs == 0)
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
455 456 457 458 459 460
      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)).         ===

461
    int mpiRank = meshDistributor->getMpiRank();
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
462 463 464 465
    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
466
	if (!isPrimal(component, it.getDofIndex())) {
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
467 468
	  boundaryDofRanks[feSpace][it.getDofIndex()].insert(mpiRank);

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

476 477 478 479

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

480
    StdMpi<vector<std::set<int> > > stdMpi(meshDistributor->getMpiComm());
481

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

    stdMpi.updateSendDataSize();

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

      if (recvFromRank)
507
	stdMpi.recv(it.getRank());
508
    }
509

510 511
    stdMpi.startCommunication();

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

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
526

527 528 529
    // === Reserve for each dual node, on the rank that owns this node, the ===
    // === appropriate number of Lagrange constraints.                      ===

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


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

    if (!augmentedLagrange)
      return;
  }


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

560
    DOFAdmin* admin = feSpace->getAdmin();
561 562 563 564

    // === 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.                                 ===
565

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

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

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


609
  void PetscSolverFeti::createMatLagrange(vector<const FiniteElemSpace*> &feSpaces)
610 611 612
  {
    FUNCNAME("PetscSolverFeti::createMatLagrange()");

Thomas Witkowski's avatar
Thomas Witkowski committed
613
    double wtime = MPI::Wtime();
614
    int mpiRank = meshDistributor->getMpiRank();
Thomas Witkowski's avatar
Thomas Witkowski committed
615

616 617
    // === Create distributed matrix for Lagrange constraints. ===

618 619 620 621 622
    MatCreateAIJ(mpiCommGlobal,
		 lagrangeMap.getRankDofs(), localDofMap.getRankDofs(),
		 lagrangeMap.getOverallDofs(), nGlobalOverallInterior,
		 2, PETSC_NULL, 2, PETSC_NULL,
		 &mat_lagrange);
623
    MatSetOption(mat_lagrange, MAT_NEW_NONZERO_ALLOCATION_ERR, PETSC_FALSE);
624

625 626 627
    Vec vec_scale_lagrange;
    lagrangeMap.createVec(vec_scale_lagrange);

628 629 630 631 632 633 634
    // === 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.                                                     ===

Thomas Witkowski's avatar
Thomas Witkowski committed
635
    for (unsigned int k = 0; k < feSpaces.size(); k++) {
636
      DofMap &dualMap = dualDofMap[feSpaces[k]].getMap();
637

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

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

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

	// === Create scaling factors for scaling the lagrange matrix, which ===
	// === is required for FETI-DP preconditioners.                      ===
	
	if (meshDistributor->getDofMap()[feSpaces[k]].isRankDof(it->first)) {
	  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);
677 678 679 680 681 682 683
	  }
	}
      }
    }

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

685

Thomas Witkowski's avatar
So on  
Thomas Witkowski committed
686 687 688 689 690 691 692 693 694 695 696 697
    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);


698 699 700 701 702 703 704 705 706 707 708 709 710 711 712
    // === 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
713 714
    if (printTimings) {
      MPI::COMM_WORLD.Barrier();
Thomas Witkowski's avatar
Thomas Witkowski committed
715 716
      MSG("FETI-DP timing 05: %.5f seconds (creation of lagrange constraint matrix)\n", 
	  MPI::Wtime() - wtime);
Thomas Witkowski's avatar
BLUB  
Thomas Witkowski committed
717
    }
718 719
  }

720

Thomas Witkowski's avatar
Thomas Witkowski committed
721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736
  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);
  }
737

738

739 740 741 742 743 744 745 746 747 748 749
  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
750
    std::set<BoundaryObject> allEdges;
751
    for (InteriorBoundary::iterator it(intBound.getOwn()); !it.end(); ++it) {
752 753 754
      if ((it->rankObj.subObj == FACE ||
	   (it->rankObj.subObj == EDGE && 
	    testWirebasketEdge(it->rankObj, feSpaces[0]))) && 
755 756 757 758 759
	  allEdges.count(it->rankObj) == 0) {
	bool dirichletOnlyEdge = true;

	DofContainer edgeDofs;
	it->rankObj.el->getAllDofs(feSpaces[0], it->rankObj, edgeDofs);
760
	
761 762 763 764 765 766 767 768 769 770 771 772
	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
773 774

    nRankEdges = allEdges.size();    
775 776 777 778
    int rStartEdges = 0;
    mpi::getDofNumbering(mpiCommGlobal, nRankEdges, rStartEdges, nOverallEdges);

    MSG("nRankEdges = %d, nOverallEdges = %d\n", nRankEdges, nOverallEdges);
779
    
780 781 782 783 784
    nRankEdges *= feSpaces.size();
    rStartEdges *= feSpaces.size();
    nOverallEdges *= feSpaces.size();

    MatCreateAIJ(mpiCommGlobal,
785 786
		 nRankEdges, lagrangeMap.getRankDofs(),
		 nOverallEdges, lagrangeMap.getOverallDofs(),
787
		 2, PETSC_NULL, 2, PETSC_NULL, 
788 789 790
		 &mat_augmented_lagrange);
    MatSetOption(mat_augmented_lagrange, MAT_NEW_NONZERO_ALLOCATION_ERR, PETSC_FALSE);

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