PetscSolverFeti.cc 77.7 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
  void PetscSolverFeti::createDirichletData(Matrix<DOFMatrix*> &mat)
  {
    FUNCNAME("PetscSolverFeti::createDirichletData()");

    int nComponents = mat.getSize();
145 146
    for (int component = 0; component < nComponents; component++) {
      DOFMatrix* dofMat = mat[component][component];
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
147 148
      if (!dofMat)
	continue;
149 150

      dirichletRows[component] = dofMat->getDirichletRows();
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
151 152 153 154
    }
  }


155 156 157 158
  void PetscSolverFeti::createFetiData()
  {
    FUNCNAME("PetscSolverFeti::createFetiData()");

Thomas Witkowski's avatar
Thomas Witkowski committed
159 160
    double timeCounter = MPI::Wtime();

161 162 163
    TEST_EXIT(meshDistributor)("No mesh distributor object defined!\n");
    TEST_EXIT(meshDistributor->getFeSpaces().size() > 0)
      ("No FE space defined in mesh distributor!\n");
164

165 166
    MeshLevelData& levelData = meshDistributor->getMeshLevelData();

167 168 169 170
    primalDofMap.clear();
    dualDofMap.clear();
    lagrangeMap.clear();
    localDofMap.clear();
171
    if (fetiPreconditioner == FETI_DIRICHLET)
172 173
      interiorDofMap.clear();

174 175
    primalDofMap.setDofComm(meshDistributor->getDofComm());
    lagrangeMap.setDofComm(meshDistributor->getDofComm());
176

177 178
    primalDofMap.setMpiComm(levelData.getMpiComm(0), 0);
    dualDofMap.setMpiComm(levelData.getMpiComm(0), 0);
179
    lagrangeMap.setMpiComm(levelData.getMpiComm(0), 0);
180
    localDofMap.setMpiComm(levelData.getMpiComm(meshLevel), meshLevel);
181
    if (fetiPreconditioner == FETI_DIRICHLET)
182
      interiorDofMap.setMpiComm(levelData.getMpiComm(meshLevel), meshLevel);
183

184 185 186
    if (meshLevel == 0)
      localDofMap.setDofComm(meshDistributor->getDofComm());
    else
187 188
      localDofMap.setDofComm(meshDistributor->getDofCommSd());

Thomas Witkowski's avatar
Thomas Witkowski committed
189
    if (stokesMode) {
190 191 192 193 194
      interfaceDofMap.clear();
      interfaceDofMap.setDofComm(meshDistributor->getDofComm());
      interfaceDofMap.setMpiComm(levelData.getMpiComm(0), 0);
    }

Thomas Witkowski's avatar
Thomas Witkowski committed
195 196
    for (unsigned int i = 0; i < meshDistributor->getComponentFeSpaces().size(); i++) {
      const FiniteElemSpace *feSpace = meshDistributor->getComponentFeSpace(i);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
197
    
Thomas Witkowski's avatar
Thomas Witkowski committed
198
      createPrimals(i, feSpace);  
199

Thomas Witkowski's avatar
Thomas Witkowski committed
200
      createDuals(i, feSpace);
201

Thomas Witkowski's avatar
Thomas Witkowski committed
202
      createInterfaceNodes(i, feSpace);
203

Thomas Witkowski's avatar
Thomas Witkowski committed
204
      createIndexB(i, feSpace);     
205
    }
Thomas Witkowski's avatar
Thomas Witkowski committed
206 207 208 209

    primalDofMap.update();
    dualDofMap.update();
    localDofMap.update();
210
    if (fetiPreconditioner == FETI_DIRICHLET)
211
      interiorDofMap.update();
Thomas Witkowski's avatar
Thomas Witkowski committed
212

Thomas Witkowski's avatar
Thomas Witkowski committed
213
    if (stokesMode)
214 215
      interfaceDofMap.update();

Thomas Witkowski's avatar
Thomas Witkowski committed
216 217 218 219
    for (unsigned int i = 0; i < meshDistributor->getComponentFeSpaces().size(); i++) {
      const FiniteElemSpace *feSpace = meshDistributor->getComponentFeSpace(i);
      createLagrange(i, feSpace);
      createAugmentedLagrange(i, feSpace);
220
    }
221

222 223 224
    lagrangeMap.update();


225 226 227 228 229 230 231 232 233 234 235 236
    // === ===

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

237
      mpi::getDofNumbering(mpiCommGlobal, groupRowsInterior,
238 239 240 241 242 243 244 245 246
			   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);
    }

247
    MSG("FETI-DP data created on mesh level %d\n", meshLevel);
248
    for (unsigned int i = 0; i < meshDistributor->getComponentFeSpaces().size(); i++) {
249
      const FiniteElemSpace *feSpace = meshDistributor->getComponentFeSpace(i);
250 251

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

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

Thomas Witkowski's avatar
Thomas Witkowski committed
273
    subdomain->setDofMapping(&localDofMap);
Thomas Witkowski's avatar
Thomas Witkowski committed
274 275 276
    subdomain->setCoarseSpaceDofMapping(&primalDofMap); 
    if (stokesMode)
      subdomain->setCoarseSpaceDofMapping(&interfaceDofMap, pressureComponent);
Thomas Witkowski's avatar
Thomas Witkowski committed
277 278

    if (printTimings) {
Thomas Witkowski's avatar
BLUB  
Thomas Witkowski committed
279
      MPI::COMM_WORLD.Barrier();
Thomas Witkowski's avatar
Thomas Witkowski committed
280
      timeCounter = MPI::Wtime() - timeCounter;
281
      MSG("FETI-DP timing 01: %.5f seconds (creation of basic data structures)\n", 
Thomas Witkowski's avatar
Thomas Witkowski committed
282 283
	  timeCounter);
    }
284 285 286
  }


Thomas Witkowski's avatar
Thomas Witkowski committed
287 288
  void PetscSolverFeti::createPrimals(int component,
				      const FiniteElemSpace *feSpace)
Thomas Witkowski's avatar
Thomas Witkowski committed
289
  {
290
    FUNCNAME("PetscSolverFeti::createPrimals()");  
291

Thomas Witkowski's avatar
Thomas Witkowski committed
292
    if (feSpace == pressureFeSpace)
293 294
      return;

295 296 297
    // === Define all vertices on the interior boundaries of the macro mesh ===
    // === to be primal variables.                                          ===

Thomas Witkowski's avatar
Thomas Witkowski committed
298
    // Set of DOF indices that are considered to be primal variables.
299
    DofContainerSet& vertices = 
300
      meshDistributor->getBoundaryDofInfo(feSpace, meshLevel).geoDofs[VERTEX];
301 302

    DofIndexSet primals;
303
    for (DofContainerSet::iterator it = vertices.begin(); 
304
	 it != vertices.end(); ++it) {
305
      
306
      if (dirichletRows[component].count(**it))
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
307
	continue;
Thomas Witkowski's avatar
Thomas Witkowski committed
308

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
309 310
      if (meshLevel == 0) {
	primals.insert(**it);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
311
      } else {
312
	double e = 1e-8;
Thomas Witkowski's avatar
Thomas Witkowski committed
313 314 315
	WorldVector<double> c;
	feSpace->getMesh()->getDofIndexCoords(*it, feSpace, c);

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
316 317 318 319 320 321 322
	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);
	}
      }
323
    }
324

325 326 327 328

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

329
    for (DofIndexSet::iterator it = primals.begin(); it != primals.end(); ++it)
330
      if (meshDistributor->getDofMap()[feSpace].isRankDof(*it)) {
Thomas Witkowski's avatar
Thomas Witkowski committed
331
	primalDofMap[component].insertRankDof(*it);
332
      } else
Thomas Witkowski's avatar
Thomas Witkowski committed
333
  	primalDofMap[component].insertNonRankDof(*it);
334 335 336
  }


Thomas Witkowski's avatar
Thomas Witkowski committed
337 338
  void PetscSolverFeti::createDuals(int component,
				    const FiniteElemSpace *feSpace)
339 340
  {
    FUNCNAME("PetscSolverFeti::createDuals()");
341

Thomas Witkowski's avatar
Thomas Witkowski committed
342
    if (feSpace == pressureFeSpace)
343 344
      return;

345 346 347
    // === Create global index of the dual nodes on each rank. ===

    DofContainer allBoundaryDofs;
348
    meshDistributor->getAllBoundaryDofs(feSpace, meshLevel, allBoundaryDofs);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
349
    
350
    for (DofContainer::iterator it = allBoundaryDofs.begin();
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
351
	 it != allBoundaryDofs.end(); ++it) {
352
      if (dirichletRows[component].count(**it))
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
353 354
	continue;

Thomas Witkowski's avatar
Thomas Witkowski committed
355
      if (isPrimal(component, **it))
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
356 357 358
	continue;

      if (meshLevel == 0) {
Thomas Witkowski's avatar
Thomas Witkowski committed
359
	dualDofMap[component].insertRankDof(**it);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
360 361
      } else {
	if (meshDistributor->getDofMapSd()[feSpace].isRankDof(**it))
Thomas Witkowski's avatar
Thomas Witkowski committed
362
	  dualDofMap[component].insertRankDof(**it);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
363 364
      }	  
    }
365 366 367
  }

  
Thomas Witkowski's avatar
Thomas Witkowski committed
368 369
  void PetscSolverFeti::createInterfaceNodes(int component,
					     const FiniteElemSpace *feSpace)
370 371 372
  {
    FUNCNAME("PetscSolverFeti::createInterfaceNodes()");

Thomas Witkowski's avatar
Thomas Witkowski committed
373
    if (feSpace != pressureFeSpace)
374 375 376 377 378 379
      return;

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

    for (DofContainer::iterator it = allBoundaryDofs.begin();
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
380
	 it != allBoundaryDofs.end(); ++it) {
381
      if (dirichletRows[component].count(**it))
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
382 383
	continue;      
      
384
      if (meshDistributor->getDofMap()[feSpace].isRankDof(**it))
Thomas Witkowski's avatar
Thomas Witkowski committed
385
	interfaceDofMap[component].insertRankDof(**it);
386
      else
Thomas Witkowski's avatar
Thomas Witkowski committed
387
	interfaceDofMap[component].insertNonRankDof(**it);      
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
388
    }
389 390 391
  }


Thomas Witkowski's avatar
Thomas Witkowski committed
392 393
  void PetscSolverFeti::createLagrange(int component,
				       const FiniteElemSpace *feSpace)
394 395 396
  {
    FUNCNAME("PetscSolverFeti::createLagrange()");

Thomas Witkowski's avatar
Thomas Witkowski committed
397
    if (feSpace == pressureFeSpace)
398 399
      return;

400 401
    boundaryDofRanks[feSpace].clear();

Thomas Witkowski's avatar
Thomas Witkowski committed
402 403 404
    // 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
405
    map<int, std::set<DegreeOfFreedom> > sdRankDofs;
406

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
407
    if (meshLevel > 0) {
408
      StdMpi<vector<int> > stdMpi(mpiCommGlobal);
409 410 411 412 413 414 415 416 417

      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
418
	  if (meshDistributor->getDofMapSd()[feSpace].isRankDof(it.getDofIndex()))
419
	    subdomainRankDofs.push_back(1);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
420
	  else
421 422 423 424 425 426 427 428 429 430 431 432 433 434 435
	    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
436 437
	   !it.end(); it.nextRank())
	for (; !it.endDofIter(); it.nextDof())
Thomas Witkowski's avatar
Thomas Witkowski committed
438
	  if (!isPrimal(component, it.getDofIndex()))
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
439 440 441
	    if (stdMpi.getRecvData(it.getRank())[it.getDofCounter()] == 1)
	      sdRankDofs[it.getRank()].insert(it.getDofIndex());
    }
442

Thomas Witkowski's avatar
Thomas Witkowski committed
443
    if (dualDofMap[component].nLocalDofs == 0)
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
444 445 446 447 448 449
      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)).         ===

450
    int mpiRank = meshDistributor->getMpiRank();
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
451 452 453 454
    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
455
	if (!isPrimal(component, it.getDofIndex())) {
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
456 457
	  boundaryDofRanks[feSpace][it.getDofIndex()].insert(mpiRank);

458
 	  if (meshLevel == 0 ||
Thomas Witkowski's avatar
Thomas Witkowski committed
459
 	      (meshLevel > 0 && sdRankDofs[it.getRank()].count(it.getDofIndex())))
460
	    boundaryDofRanks[feSpace][it.getDofIndex()].insert(it.getRank());	  
461 462 463 464
	}
      }
    }

465 466 467 468

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

469
    StdMpi<vector<std::set<int> > > stdMpi(meshDistributor->getMpiComm());
470

471
    for (DofComm::Iterator it(meshDistributor->getDofComm().getSendDofs(), meshLevel, feSpace);
472 473
	 !it.end(); it.nextRank())
      for (; !it.endDofIter(); it.nextDof())
Thomas Witkowski's avatar
Thomas Witkowski committed
474
	if (!isPrimal(component, it.getDofIndex()))
475 476 477
 	  if (meshLevel == 0 ||
 	      (meshLevel > 0 && sdRankDofs[it.getRank()].count(it.getDofIndex())))
	    stdMpi.getSendData(it.getRank()).push_back(boundaryDofRanks[feSpace][it.getDofIndex()]);
478 479 480

    stdMpi.updateSendDataSize();

481
    for (DofComm::Iterator it(meshDistributor->getDofComm().getRecvDofs(), meshLevel, feSpace); 
482
	 !it.end(); it.nextRank()) {
483
      bool recvFromRank = false;
484
      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 && 
 	       meshDistributor->getDofMapSd()[feSpace].isRankDof(it.getDofIndex()))) {
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
489 490 491
	    recvFromRank = true;
	    break;
	  }
492
	}
493
      }
494 495

      if (recvFromRank)
496
	stdMpi.recv(it.getRank());
497
    }
498

499 500
    stdMpi.startCommunication();

501
    for (DofComm::Iterator it(meshDistributor->getDofComm().getRecvDofs(), meshLevel, feSpace); 
502
	 !it.end(); it.nextRank()) {
503
      int i = 0;
504
      for (; !it.endDofIter(); it.nextDof())
Thomas Witkowski's avatar
Thomas Witkowski committed
505
	if (!isPrimal(component, it.getDofIndex()))
506 507 508
 	  if (meshLevel == 0 ||
 	      (meshLevel > 0 && 
 	       meshDistributor->getDofMapSd()[feSpace].isRankDof(it.getDofIndex())))	    
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
509 510
	    boundaryDofRanks[feSpace][it.getDofIndex()] = 
	      stdMpi.getRecvData(it.getRank())[i++];
511
	  else
Thomas Witkowski's avatar
Thomas Witkowski committed
512
	    lagrangeMap[component].insertNonRankDof(it.getDofIndex());
513 514
    }

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
515

516 517 518
    // === Reserve for each dual node, on the rank that owns this node, the ===
    // === appropriate number of Lagrange constraints.                      ===

519
    int nRankLagrange = 0;
520
    DofMap& dualMap = dualDofMap[component].getMap();
521
    for (DofMap::iterator it = dualMap.begin(); it != dualMap.end(); ++it) {
522
      if (meshDistributor->getDofMap()[feSpace].isRankDof(it->first)) {
Thomas Witkowski's avatar
Thomas Witkowski committed
523
	lagrangeMap[component].insertRankDof(it->first, nRankLagrange);
524
	int degree = boundaryDofRanks[feSpace][it->first].size();
525
	nRankLagrange += (degree * (degree - 1)) / 2;
Thomas Witkowski's avatar
Thomas Witkowski committed
526
      } else {
Thomas Witkowski's avatar
Thomas Witkowski committed
527
	lagrangeMap[component].insertNonRankDof(it->first);
528 529
      }
    }
Thomas Witkowski's avatar
Thomas Witkowski committed
530
    lagrangeMap[component].nRankDofs = nRankLagrange;
531 532 533
  }


Thomas Witkowski's avatar
Thomas Witkowski committed
534 535
  void PetscSolverFeti::createAugmentedLagrange(int component,
						const FiniteElemSpace *feSpace)
536 537 538 539 540 541 542 543
  {
    FUNCNAME("PetscSolverFeti::createAugmentedLagrange()");

    if (!augmentedLagrange)
      return;
  }


Thomas Witkowski's avatar
Thomas Witkowski committed
544 545
  void PetscSolverFeti::createIndexB(int component,
				     const FiniteElemSpace *feSpace)
546
  {
547
    FUNCNAME("PetscSolverFeti::createIndexB()");
548

549
    DOFAdmin* admin = feSpace->getAdmin();
550 551 552 553

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

555
    int nLocalInterior = 0;    
556
    for (int i = 0; i < admin->getUsedSize(); i++) {
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
557
      if (admin->isDofFree(i) ||
Thomas Witkowski's avatar
Thomas Witkowski committed
558 559 560
	  isPrimal(component, i) ||
	  isDual(component, i) ||
	  isInterface(component, i) ||
561
	  dirichletRows[component].count(i))
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
562
	continue;      
563

Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
564
      if (meshLevel == 0) {
Thomas Witkowski's avatar
Thomas Witkowski committed
565
	localDofMap[component].insertRankDof(i, nLocalInterior);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
566 567
	
	if (fetiPreconditioner == FETI_DIRICHLET)
568
	  interiorDofMap[component].insertRankDof(i, nLocalInterior);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
569 570 571 572
	
	nLocalInterior++;	
      } else {
	if (meshDistributor->getDofMapSd()[feSpace].isRankDof(i))
Thomas Witkowski's avatar
Thomas Witkowski committed
573
	  localDofMap[component].insertRankDof(i);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
574
	else
Thomas Witkowski's avatar
Thomas Witkowski committed
575
	  localDofMap[component].insertNonRankDof(i);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
576 577 578
	
	TEST_EXIT_DBG(fetiPreconditioner == FETI_NONE)
	  ("Not yet implemnted!\n");	
579
      }
580
    }
Thomas Witkowski's avatar
FETI-DP  
Thomas Witkowski committed
581
    
582 583
    // === And finally, add the global indicies of all dual nodes. ===

584 585
    for (DofMap::iterator it = dualDofMap[component].getMap().begin();
	 it != dualDofMap[component].getMap().end(); ++it) {
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
586
      if (meshLevel == 0) {
Thomas Witkowski's avatar
Thomas Witkowski committed
587
	localDofMap[component].insertRankDof(it->first);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
588
      } else {
589
	if (meshDistributor->getDofMapSd()[feSpace].isRankDof(it->first))
Thomas Witkowski's avatar
Thomas Witkowski committed
590
	  localDofMap[component].insertRankDof(it->first);
591
	else 
Thomas Witkowski's avatar
Thomas Witkowski committed
592
	  localDofMap[component].insertNonRankDof(it->first);
593
      }
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
594
    }
595 596 597
  }


598
  void PetscSolverFeti::createMatLagrange(vector<const FiniteElemSpace*> &feSpaces)
599 600 601
  {
    FUNCNAME("PetscSolverFeti::createMatLagrange()");

Thomas Witkowski's avatar
Thomas Witkowski committed
602
    double wtime = MPI::Wtime();
603
    int mpiRank = meshDistributor->getMpiRank();
Thomas Witkowski's avatar
Thomas Witkowski committed
604

605 606
    // === Create distributed matrix for Lagrange constraints. ===

607 608 609 610 611
    MatCreateAIJ(mpiCommGlobal,
		 lagrangeMap.getRankDofs(), localDofMap.getRankDofs(),
		 lagrangeMap.getOverallDofs(), nGlobalOverallInterior,
		 2, PETSC_NULL, 2, PETSC_NULL,
		 &mat_lagrange);
612
    MatSetOption(mat_lagrange, MAT_NEW_NONZERO_ALLOCATION_ERR, PETSC_FALSE);
613

614 615 616
    Vec vec_scale_lagrange;
    lagrangeMap.createVec(vec_scale_lagrange);

617 618 619 620 621 622 623
    // === 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.                                                     ===

624 625
    for (unsigned int component = 0; component < feSpaces.size(); component++) {
      DofMap &dualMap = dualDofMap[component].getMap();
626

627
      for (DofMap::iterator it = dualMap.begin(); it != dualMap.end(); ++it) {
628
	TEST_EXIT_DBG(boundaryDofRanks[feSpaces[component]].count(it->first))
Thomas Witkowski's avatar
Thomas Witkowski committed
629 630 631
	  ("Should not happen!\n");
	
	// Global index of the first Lagrange constriant for this node.
632
	int index = lagrangeMap.getMatIndex(component, it->first);
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
633

Thomas Witkowski's avatar
Thomas Witkowski committed
634
	// Copy set of all ranks that contain this dual node.
635 636
	vector<int> W(boundaryDofRanks[feSpaces[component]][it->first].begin(), 
		      boundaryDofRanks[feSpaces[component]][it->first].end());
Thomas Witkowski's avatar
Thomas Witkowski committed
637 638
	// Number of ranks that contain this dual node.
	int degree = W.size();
Thomas Witkowski's avatar
Blub  
Thomas Witkowski committed
639 640

	TEST_EXIT_DBG(degree > 1)("Should not happen!\n");
Thomas Witkowski's avatar
Thomas Witkowski committed
641
	
642
	int counter = 0;
Thomas Witkowski's avatar
Thomas Witkowski committed
643 644 645
	for (int i = 0; i < degree; i++) {
	  for (int j = i + 1; j < degree; j++) {
	    if (W[i] == mpiRank || W[j] == mpiRank) {
646 647
	      MatSetValue(mat_lagrange, 
			  index + counter, 
648
			  localDofMap.getMatIndex(component, it->first) + rStartInterior,
649 650
			  (W[i] == mpiRank ? 1.0 : -1.0),
			  INSERT_VALUES);
651
	    }
652 653 654 655 656 657 658
	    counter++;
	  }
	}

	// === Create scaling factors for scaling the lagrange matrix, which ===
	// === is required for FETI-DP preconditioners.                      ===
	
659
	if (meshDistributor->getDofMap()[feSpaces[component]].isRankDof(it->first)) {
660 661 662 663 664 665
	  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);
666 667 668 669 670 671 672
	  }
	}
      }
    }

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

674

Thomas Witkowski's avatar
So on  
Thomas Witkowski committed
675 676 677 678 679 680 681 682 683 684 685 686
    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);


687 688 689 690 691 692 693 694 695 696 697 698 699 700 701
    // === 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
702 703
    if (printTimings) {
      MPI::COMM_WORLD.Barrier();
Thomas Witkowski's avatar
Thomas Witkowski committed
704 705
      MSG("FETI-DP timing 05: %.5f seconds (creation of lagrange constraint matrix)\n", 
	  MPI::Wtime() - wtime);
Thomas Witkowski's avatar
BLUB  
Thomas Witkowski committed
706
    }
707 708
  }

709

Thomas Witkowski's avatar
Thomas Witkowski committed
710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725
  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);
  }
726

727

728 729 730 731 732 733 734 735 736 737 738
  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
739
    std::set<BoundaryObject> allEdges;
740
    for (InteriorBoundary::iterator it(intBound.getOwn()); !it.end(); ++it) {
741 742 743
      if ((it->rankObj.subObj == FACE ||
	   (it->rankObj.subObj == EDGE && 
	    testWirebasketEdge(it->rankObj, feSpaces[0]))) && 
744 745 746 747 748
	  allEdges.count(it->rankObj) == 0) {
	bool dirichletOnlyEdge = true;

	DofContainer edgeDofs;
	it->rankObj.el->getAllDofs(feSpaces[0], it->rankObj, edgeDofs);
749
	
750 751
	for (DofContainer::iterator dit = edgeDofs.begin();
	     dit != edgeDofs.end(); ++dit) {
752
	  if (dirichletRows[0].count(**dit) == 0) {
753 754 755 756 757 758 759 760 761
	    dirichletOnlyEdge = false;
	    break;
	  }
	}

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

    nRankEdges = allEdges.size();    
764 765 766 767
    int rStartEdges = 0;
    mpi::getDofNumbering(mpiCommGlobal, nRankEdges, rStartEdges, nOverallEdges);

    MSG("nRankEdges = %d, nOverallEdges = %d\n", nRankEdges, nOverallEdges);
768
    
769 770 771 772 773
    nRankEdges *= feSpaces.size();
    rStartEdges *= feSpaces.size();
    nOverallEdges *= feSpaces.size();

    MatCreateAIJ(mpiCommGlobal,
774 775
		 nRankEdges, lagrangeMap.getRankDofs(),
		 nOverallEdges, lagrangeMap.getOverallDofs(),
776
		 2, PETSC_NULL, 2, PETSC_NULL, 
777 778 779
		 &mat_augmented_lagrange);
    MatSetOption(mat_augmented_lagrange, MAT_NEW_NONZERO_ALLOCATION_ERR, PETSC_FALSE);

780
    int rowCounter = rStartEdges;
Thomas Witkowski's avatar
Thomas Witkowski committed
781 782
    for (std::set<BoundaryObject>::iterator edgeIt = allEdges.begin(); 
	 edgeIt != allEdges.end(); ++edgeIt) {
Thomas Witkowski's avatar
Thomas Witkowski committed
783