xref: /petsc/src/ksp/pc/impls/bddc/bddcschurs.c (revision 0090e2cf8650914f034c1a2436476dfd4612a0b3)
1 #include <../src/ksp/pc/impls/bddc/bddc.h>
2 #include <../src/ksp/pc/impls/bddc/bddcprivate.h>
3 #include <../src/mat/impls/dense/seq/dense.h>
4 #include <petscblaslapack.h>
5 
6 PETSC_STATIC_INLINE PetscErrorCode PCBDDCAdjGetNextLayer_Private(PetscInt*,PetscInt,PetscBT,PetscInt*,PetscInt*,PetscInt*);
7 static PetscErrorCode PCBDDCComputeExplicitSchur(Mat,PetscBool,MatReuse,Mat*);
8 static PetscErrorCode PCBDDCReuseSolvers_Interior(PC,Vec,Vec);
9 static PetscErrorCode PCBDDCReuseSolvers_Correction(PC,Vec,Vec);
10 
11 /* if v2 is not present, correction is done in-place */
12 PetscErrorCode PCBDDCReuseSolversBenignAdapt(PCBDDCReuseSolvers ctx, Vec v, Vec v2, PetscBool sol, PetscBool full)
13 {
14   PetscScalar    *array;
15   PetscScalar    *array2;
16   PetscErrorCode ierr;
17 
18   PetscFunctionBegin;
19   if (!ctx->benign_n) PetscFunctionReturn(0);
20   if (sol && full) {
21     PetscInt n_I,size_schur;
22 
23     /* get sizes */
24     ierr = MatGetSize(ctx->benign_csAIB,&size_schur,NULL);CHKERRQ(ierr);
25     ierr = VecGetSize(v,&n_I);CHKERRQ(ierr);
26     n_I = n_I - size_schur;
27     /* get schur sol from array */
28     ierr = VecGetArray(v,&array);CHKERRQ(ierr);
29     ierr = VecPlaceArray(ctx->benign_dummy_schur_vec,array+n_I);CHKERRQ(ierr);
30     ierr = VecRestoreArray(v,&array);CHKERRQ(ierr);
31     /* apply interior sol correction */
32     ierr = MatMultTranspose(ctx->benign_csAIB,ctx->benign_dummy_schur_vec,ctx->benign_corr_work);CHKERRQ(ierr);
33     ierr = VecResetArray(ctx->benign_dummy_schur_vec);CHKERRQ(ierr);
34     ierr = MatMultAdd(ctx->benign_AIIm1ones,ctx->benign_corr_work,v,v);CHKERRQ(ierr);
35   }
36   if (v2) {
37     PetscInt nl;
38 
39     ierr = VecGetArrayRead(v,(const PetscScalar**)&array);CHKERRQ(ierr);
40     ierr = VecGetLocalSize(v2,&nl);CHKERRQ(ierr);
41     ierr = VecGetArray(v2,&array2);CHKERRQ(ierr);
42     ierr = PetscMemcpy(array2,array,nl*sizeof(PetscScalar));CHKERRQ(ierr);
43   } else {
44     ierr = VecGetArray(v,&array);CHKERRQ(ierr);
45     array2 = array;
46   }
47   if (!sol) { /* change rhs */
48     PetscInt n;
49     for (n=0;n<ctx->benign_n;n++) {
50       PetscScalar    sum = 0.;
51       const PetscInt *cols;
52       PetscInt       nz,i;
53 
54       ierr = ISGetLocalSize(ctx->benign_zerodiag_subs[n],&nz);CHKERRQ(ierr);
55       ierr = ISGetIndices(ctx->benign_zerodiag_subs[n],&cols);CHKERRQ(ierr);
56       for (i=0;i<nz-1;i++) sum += array[cols[i]];
57 #if defined(PETSC_USE_COMPLEX)
58       sum = -(PetscRealPart(sum)/nz + PETSC_i*(PetscImaginaryPart(sum)/nz));
59 #else
60       sum = -sum/nz;
61 #endif
62       for (i=0;i<nz-1;i++) array2[cols[i]] += sum;
63       ctx->benign_save_vals[n] = array2[cols[nz-1]];
64       array2[cols[nz-1]] = sum;
65       ierr = ISRestoreIndices(ctx->benign_zerodiag_subs[n],&cols);CHKERRQ(ierr);
66     }
67   } else {
68     PetscInt n;
69     for (n=0;n<ctx->benign_n;n++) {
70       PetscScalar    sum = 0.;
71       const PetscInt *cols;
72       PetscInt       nz,i;
73       ierr = ISGetLocalSize(ctx->benign_zerodiag_subs[n],&nz);CHKERRQ(ierr);
74       ierr = ISGetIndices(ctx->benign_zerodiag_subs[n],&cols);CHKERRQ(ierr);
75       for (i=0;i<nz-1;i++) sum += array[cols[i]];
76 #if defined(PETSC_USE_COMPLEX)
77       sum = -(PetscRealPart(sum)/nz + PETSC_i*(PetscImaginaryPart(sum)/nz));
78 #else
79       sum = -sum/nz;
80 #endif
81       for (i=0;i<nz-1;i++) array2[cols[i]] += sum;
82       array2[cols[nz-1]] = ctx->benign_save_vals[n];
83       ierr = ISRestoreIndices(ctx->benign_zerodiag_subs[n],&cols);CHKERRQ(ierr);
84     }
85   }
86   if (v2) {
87     ierr = VecRestoreArrayRead(v,(const PetscScalar**)&array);CHKERRQ(ierr);
88     ierr = VecRestoreArray(v2,&array2);CHKERRQ(ierr);
89   } else {
90     ierr = VecRestoreArray(v,&array);CHKERRQ(ierr);
91   }
92   if (!sol && full) {
93     Vec      usedv;
94     PetscInt n_I,size_schur;
95 
96     /* get sizes */
97     ierr = MatGetSize(ctx->benign_csAIB,&size_schur,NULL);CHKERRQ(ierr);
98     ierr = VecGetSize(v,&n_I);CHKERRQ(ierr);
99     n_I = n_I - size_schur;
100     /* compute schur rhs correction */
101     if (v2) {
102       usedv = v2;
103     } else {
104       usedv = v;
105     }
106     /* apply schur rhs correction */
107     ierr = MatMultTranspose(ctx->benign_AIIm1ones,usedv,ctx->benign_corr_work);CHKERRQ(ierr);
108     ierr = VecGetArrayRead(usedv,(const PetscScalar**)&array);CHKERRQ(ierr);
109     ierr = VecPlaceArray(ctx->benign_dummy_schur_vec,array+n_I);CHKERRQ(ierr);
110     ierr = VecRestoreArrayRead(usedv,(const PetscScalar**)&array);CHKERRQ(ierr);
111     ierr = MatMultAdd(ctx->benign_csAIB,ctx->benign_corr_work,ctx->benign_dummy_schur_vec,ctx->benign_dummy_schur_vec);CHKERRQ(ierr);
112     ierr = VecResetArray(ctx->benign_dummy_schur_vec);CHKERRQ(ierr);
113   }
114   PetscFunctionReturn(0);
115 }
116 
117 static PetscErrorCode PCBDDCReuseSolvers_Solve_Private(PC pc, Vec rhs, Vec sol, PetscBool transpose, PetscBool full)
118 {
119   PCBDDCReuseSolvers ctx;
120   PetscBool          copy = PETSC_FALSE;
121   PetscErrorCode     ierr;
122 
123   PetscFunctionBegin;
124   ierr = PCShellGetContext(pc,(void **)&ctx);CHKERRQ(ierr);
125   if (full) {
126 #if defined(PETSC_HAVE_MUMPS)
127     ierr = MatMumpsSetIcntl(ctx->F,26,-1);CHKERRQ(ierr);
128 #endif
129 #if defined(PETSC_HAVE_MKL_PARDISO)
130     ierr = MatMkl_PardisoSetCntl(ctx->F,70,0);CHKERRQ(ierr);
131 #endif
132     copy = ctx->has_vertices;
133   } else { /* interior solver */
134 #if defined(PETSC_HAVE_MUMPS)
135     ierr = MatMumpsSetIcntl(ctx->F,26,0);CHKERRQ(ierr);
136 #endif
137 #if defined(PETSC_HAVE_MKL_PARDISO)
138     ierr = MatMkl_PardisoSetCntl(ctx->F,70,1);CHKERRQ(ierr);
139 #endif
140     copy = PETSC_TRUE;
141   }
142   /* copy rhs into factored matrix workspace */
143   if (copy) {
144     PetscInt    n;
145     PetscScalar *array,*array_solver;
146 
147     ierr = VecGetLocalSize(rhs,&n);CHKERRQ(ierr);
148     ierr = VecGetArrayRead(rhs,(const PetscScalar**)&array);CHKERRQ(ierr);
149     ierr = VecGetArray(ctx->rhs,&array_solver);CHKERRQ(ierr);
150     ierr = PetscMemcpy(array_solver,array,n*sizeof(PetscScalar));CHKERRQ(ierr);
151     ierr = VecRestoreArray(ctx->rhs,&array_solver);CHKERRQ(ierr);
152     ierr = VecRestoreArrayRead(rhs,(const PetscScalar**)&array);CHKERRQ(ierr);
153 
154     ierr = PCBDDCReuseSolversBenignAdapt(ctx,ctx->rhs,NULL,PETSC_FALSE,full);CHKERRQ(ierr);
155     if (transpose) {
156       ierr = MatSolveTranspose(ctx->F,ctx->rhs,ctx->sol);CHKERRQ(ierr);
157     } else {
158       ierr = MatSolve(ctx->F,ctx->rhs,ctx->sol);CHKERRQ(ierr);
159     }
160     ierr = PCBDDCReuseSolversBenignAdapt(ctx,ctx->sol,NULL,PETSC_TRUE,full);CHKERRQ(ierr);
161 
162     /* get back data to caller worskpace */
163     ierr = VecGetArrayRead(ctx->sol,(const PetscScalar**)&array_solver);CHKERRQ(ierr);
164     ierr = VecGetArray(sol,&array);CHKERRQ(ierr);
165     ierr = PetscMemcpy(array,array_solver,n*sizeof(PetscScalar));CHKERRQ(ierr);
166     ierr = VecRestoreArray(sol,&array);CHKERRQ(ierr);
167     ierr = VecRestoreArrayRead(ctx->sol,(const PetscScalar**)&array_solver);CHKERRQ(ierr);
168   } else {
169     if (ctx->benign_n) {
170       ierr = PCBDDCReuseSolversBenignAdapt(ctx,rhs,ctx->rhs,PETSC_FALSE,full);CHKERRQ(ierr);
171       if (transpose) {
172         ierr = MatSolveTranspose(ctx->F,ctx->rhs,sol);CHKERRQ(ierr);
173       } else {
174         ierr = MatSolve(ctx->F,ctx->rhs,sol);CHKERRQ(ierr);
175       }
176       ierr = PCBDDCReuseSolversBenignAdapt(ctx,sol,NULL,PETSC_TRUE,full);CHKERRQ(ierr);
177     } else {
178       if (transpose) {
179         ierr = MatSolveTranspose(ctx->F,rhs,sol);CHKERRQ(ierr);
180       } else {
181         ierr = MatSolve(ctx->F,rhs,sol);CHKERRQ(ierr);
182       }
183     }
184   }
185   /* restore defaults */
186 #if defined(PETSC_HAVE_MUMPS)
187   ierr = MatMumpsSetIcntl(ctx->F,26,-1);CHKERRQ(ierr);
188 #endif
189 #if defined(PETSC_HAVE_MKL_PARDISO)
190   ierr = MatMkl_PardisoSetCntl(ctx->F,70,0);CHKERRQ(ierr);
191 #endif
192   PetscFunctionReturn(0);
193 }
194 
195 static PetscErrorCode PCBDDCReuseSolvers_Correction(PC pc, Vec rhs, Vec sol)
196 {
197   PetscErrorCode   ierr;
198 
199   PetscFunctionBegin;
200   ierr = PCBDDCReuseSolvers_Solve_Private(pc,rhs,sol,PETSC_FALSE,PETSC_TRUE);CHKERRQ(ierr);
201   PetscFunctionReturn(0);
202 }
203 
204 static PetscErrorCode PCBDDCReuseSolvers_CorrectionTranspose(PC pc, Vec rhs, Vec sol)
205 {
206   PetscErrorCode   ierr;
207 
208   PetscFunctionBegin;
209   ierr = PCBDDCReuseSolvers_Solve_Private(pc,rhs,sol,PETSC_TRUE,PETSC_TRUE);CHKERRQ(ierr);
210   PetscFunctionReturn(0);
211 }
212 
213 static PetscErrorCode PCBDDCReuseSolvers_Interior(PC pc, Vec rhs, Vec sol)
214 {
215   PetscErrorCode   ierr;
216 
217   PetscFunctionBegin;
218   ierr = PCBDDCReuseSolvers_Solve_Private(pc,rhs,sol,PETSC_FALSE,PETSC_FALSE);CHKERRQ(ierr);
219   PetscFunctionReturn(0);
220 }
221 
222 static PetscErrorCode PCBDDCReuseSolvers_InteriorTranspose(PC pc, Vec rhs, Vec sol)
223 {
224   PetscErrorCode   ierr;
225 
226   PetscFunctionBegin;
227   ierr = PCBDDCReuseSolvers_Solve_Private(pc,rhs,sol,PETSC_TRUE,PETSC_FALSE);CHKERRQ(ierr);
228   PetscFunctionReturn(0);
229 }
230 
231 static PetscErrorCode PCBDDCReuseSolversReset(PCBDDCReuseSolvers reuse)
232 {
233   PetscInt       i;
234   PetscErrorCode ierr;
235 
236   PetscFunctionBegin;
237   ierr = MatDestroy(&reuse->F);CHKERRQ(ierr);
238   ierr = VecDestroy(&reuse->sol);CHKERRQ(ierr);
239   ierr = VecDestroy(&reuse->rhs);CHKERRQ(ierr);
240   ierr = PCDestroy(&reuse->interior_solver);CHKERRQ(ierr);
241   ierr = PCDestroy(&reuse->correction_solver);CHKERRQ(ierr);
242   ierr = ISDestroy(&reuse->is_R);CHKERRQ(ierr);
243   ierr = ISDestroy(&reuse->is_B);CHKERRQ(ierr);
244   ierr = VecScatterDestroy(&reuse->correction_scatter_B);CHKERRQ(ierr);
245   ierr = VecDestroy(&reuse->sol_B);CHKERRQ(ierr);
246   ierr = VecDestroy(&reuse->rhs_B);CHKERRQ(ierr);
247   for (i=0;i<reuse->benign_n;i++) {
248     ierr = ISDestroy(&reuse->benign_zerodiag_subs[i]);CHKERRQ(ierr);
249   }
250   ierr = PetscFree(reuse->benign_zerodiag_subs);CHKERRQ(ierr);
251   ierr = PetscFree(reuse->benign_save_vals);CHKERRQ(ierr);
252   ierr = MatDestroy(&reuse->benign_csAIB);CHKERRQ(ierr);
253   ierr = MatDestroy(&reuse->benign_AIIm1ones);CHKERRQ(ierr);
254   ierr = VecDestroy(&reuse->benign_corr_work);CHKERRQ(ierr);
255   ierr = VecDestroy(&reuse->benign_dummy_schur_vec);CHKERRQ(ierr);
256   PetscFunctionReturn(0);
257 }
258 
259 static PetscErrorCode PCBDDCComputeExplicitSchur(Mat M, PetscBool issym, MatReuse reuse, Mat *S)
260 {
261   Mat            B, C, D, Bd, Cd, AinvBd;
262   KSP            ksp;
263   PC             pc;
264   PetscBool      isLU, isILU, isCHOL, Bdense, Cdense;
265   PetscReal      fill = 2.0;
266   PetscInt       n_I;
267   PetscMPIInt    size;
268   PetscErrorCode ierr;
269 
270   PetscFunctionBegin;
271   ierr = MPI_Comm_size(PetscObjectComm((PetscObject)M),&size);CHKERRQ(ierr);
272   if (size != 1) SETERRQ(PETSC_COMM_SELF,PETSC_ERR_SUP,"Not for parallel matrices");
273   if (reuse == MAT_REUSE_MATRIX) {
274     PetscBool Sdense;
275 
276     ierr = PetscObjectTypeCompare((PetscObject)*S, MATSEQDENSE, &Sdense);CHKERRQ(ierr);
277     if (!Sdense) SETERRQ(PetscObjectComm((PetscObject)M),PETSC_ERR_SUP,"S should dense");
278   }
279   ierr = MatSchurComplementGetSubMatrices(M, NULL, NULL, &B, &C, &D);CHKERRQ(ierr);
280   ierr = MatSchurComplementGetKSP(M, &ksp);CHKERRQ(ierr);
281   ierr = KSPGetPC(ksp, &pc);CHKERRQ(ierr);
282   ierr = PetscObjectTypeCompare((PetscObject) pc, PCLU, &isLU);CHKERRQ(ierr);
283   ierr = PetscObjectTypeCompare((PetscObject) pc, PCILU, &isILU);CHKERRQ(ierr);
284   ierr = PetscObjectTypeCompare((PetscObject) pc, PCCHOLESKY, &isCHOL);CHKERRQ(ierr);
285   ierr = PetscObjectTypeCompare((PetscObject) B, MATSEQDENSE, &Bdense);CHKERRQ(ierr);
286   ierr = PetscObjectTypeCompare((PetscObject) C, MATSEQDENSE, &Cdense);CHKERRQ(ierr);
287   ierr = MatGetSize(B,&n_I,NULL);CHKERRQ(ierr);
288   if (n_I) {
289     if (!Bdense) {
290       ierr = MatConvert(B, MATSEQDENSE, MAT_INITIAL_MATRIX, &Bd);CHKERRQ(ierr);
291     } else {
292       Bd = B;
293     }
294 
295     if (isLU || isILU || isCHOL) {
296       Mat fact;
297       ierr = KSPSetUp(ksp);CHKERRQ(ierr);
298       ierr = PCFactorGetMatrix(pc, &fact);CHKERRQ(ierr);
299       ierr = MatDuplicate(Bd, MAT_DO_NOT_COPY_VALUES, &AinvBd);CHKERRQ(ierr);
300       ierr = MatMatSolve(fact, Bd, AinvBd);CHKERRQ(ierr);
301     } else {
302       PetscBool ex = PETSC_TRUE;
303 
304       if (ex) {
305         Mat Ainvd;
306 
307         ierr = PCComputeExplicitOperator(pc, &Ainvd);CHKERRQ(ierr);
308         ierr = MatMatMult(Ainvd, Bd, MAT_INITIAL_MATRIX, fill, &AinvBd);CHKERRQ(ierr);
309         ierr = MatDestroy(&Ainvd);CHKERRQ(ierr);
310       } else {
311         Vec         sol,rhs;
312         PetscScalar *arrayrhs,*arraysol;
313         PetscInt    i,nrhs,n;
314 
315         ierr = MatDuplicate(Bd, MAT_DO_NOT_COPY_VALUES, &AinvBd);CHKERRQ(ierr);
316         ierr = MatGetSize(Bd,&n,&nrhs);CHKERRQ(ierr);
317         ierr = MatDenseGetArray(Bd,&arrayrhs);CHKERRQ(ierr);
318         ierr = MatDenseGetArray(AinvBd,&arraysol);CHKERRQ(ierr);
319         ierr = KSPGetSolution(ksp,&sol);CHKERRQ(ierr);
320         ierr = KSPGetRhs(ksp,&rhs);CHKERRQ(ierr);
321         for (i=0;i<nrhs;i++) {
322           ierr = VecPlaceArray(rhs,arrayrhs+i*n);CHKERRQ(ierr);
323           ierr = VecPlaceArray(sol,arraysol+i*n);CHKERRQ(ierr);
324           ierr = KSPSolve(ksp,rhs,sol);CHKERRQ(ierr);
325           ierr = VecResetArray(rhs);CHKERRQ(ierr);
326           ierr = VecResetArray(sol);CHKERRQ(ierr);
327         }
328         ierr = MatDenseRestoreArray(Bd,&arrayrhs);CHKERRQ(ierr);
329         ierr = MatDenseRestoreArray(AinvBd,&arrayrhs);CHKERRQ(ierr);
330       }
331     }
332     if (!Bdense & !issym) {
333       ierr = MatDestroy(&Bd);CHKERRQ(ierr);
334     }
335 
336     if (!issym) {
337       if (!Cdense) {
338         ierr = MatConvert(C, MATSEQDENSE, MAT_INITIAL_MATRIX, &Cd);CHKERRQ(ierr);
339       } else {
340         Cd = C;
341       }
342       ierr = MatMatMult(Cd, AinvBd, reuse, fill, S);CHKERRQ(ierr);
343       if (!Cdense) {
344         ierr = MatDestroy(&Cd);CHKERRQ(ierr);
345       }
346     } else {
347       ierr = MatTransposeMatMult(Bd, AinvBd, reuse, fill, S);CHKERRQ(ierr);
348       if (!Bdense) {
349         ierr = MatDestroy(&Bd);CHKERRQ(ierr);
350       }
351     }
352     ierr = MatDestroy(&AinvBd);CHKERRQ(ierr);
353   }
354 
355   if (D) {
356     Mat       Dd;
357     PetscBool Ddense;
358 
359     ierr = PetscObjectTypeCompare((PetscObject)D,MATSEQDENSE,&Ddense);CHKERRQ(ierr);
360     if (!Ddense) {
361       ierr = MatConvert(D, MATSEQDENSE, MAT_INITIAL_MATRIX, &Dd);CHKERRQ(ierr);
362     } else {
363       Dd = D;
364     }
365     if (n_I) {
366       ierr = MatAYPX(*S,-1.0,Dd,SAME_NONZERO_PATTERN);CHKERRQ(ierr);
367     } else {
368       if (reuse == MAT_INITIAL_MATRIX) {
369         ierr = MatDuplicate(Dd,MAT_COPY_VALUES,S);CHKERRQ(ierr);
370       } else {
371         ierr = MatCopy(Dd,*S,SAME_NONZERO_PATTERN);CHKERRQ(ierr);
372       }
373     }
374     if (!Ddense) {
375       ierr = MatDestroy(&Dd);CHKERRQ(ierr);
376     }
377   } else {
378     ierr = MatScale(*S,-1.0);CHKERRQ(ierr);
379   }
380   PetscFunctionReturn(0);
381 }
382 
383 PetscErrorCode PCBDDCSubSchursSetUp(PCBDDCSubSchurs sub_schurs, Mat Ain, Mat Sin, PetscBool exact_schur, PetscInt xadj[], PetscInt adjncy[], PetscInt nlayers, Vec scaling, PetscBool compute_Stilda, PetscBool reuse_solvers, PetscBool benign_trick, PetscInt benign_n, PetscInt benign_p0_lidx[], IS benign_zerodiag_subs[], Mat change, IS change_primal)
384 {
385   Mat                    F,A_II,A_IB,A_BI,A_BB,AE_II;
386   Mat                    S_all;
387   Mat                    global_schur_subsets,work_mat,*submats;
388   ISLocalToGlobalMapping l2gmap_subsets;
389   IS                     is_I,is_I_layer;
390   IS                     all_subsets,all_subsets_mult,all_subsets_n;
391   PetscInt               *nnz,*all_local_idx_N;
392   PetscInt               *auxnum1,*auxnum2;
393   PetscInt               i,subset_size,max_subset_size;
394   PetscInt               n_B,extra,local_size,global_size;
395   PetscBLASInt           B_N,B_ierr,B_lwork,*pivots;
396   PetscScalar            *Bwork;
397   PetscSubcomm           subcomm;
398   PetscMPIInt            color,rank;
399   MPI_Comm               comm_n;
400   PetscBool              deluxe = PETSC_TRUE, use_getr = PETSC_FALSE;
401   PetscErrorCode         ierr;
402 
403   PetscFunctionBegin;
404   ierr = MatDestroy(&sub_schurs->A);CHKERRQ(ierr);
405   ierr = MatDestroy(&sub_schurs->S);CHKERRQ(ierr);
406 
407   sub_schurs->is_hermitian = PETSC_TRUE;
408   sub_schurs->is_posdef    = PETSC_TRUE;
409   if (benign_trick) sub_schurs->is_posdef = PETSC_FALSE;
410   ierr = PetscOptionsBegin(PetscObjectComm((PetscObject)sub_schurs->l2gmap),sub_schurs->prefix,"BDDC sub_schurs options","PC");CHKERRQ(ierr);
411   ierr = PetscOptionsBool("-sub_schurs_hermitian","Hermitian problem",NULL,sub_schurs->is_hermitian,&sub_schurs->is_hermitian,NULL);CHKERRQ(ierr);
412   ierr = PetscOptionsBool("-sub_schurs_posdef","Positive definite problem",NULL,sub_schurs->is_posdef,&sub_schurs->is_posdef,NULL);CHKERRQ(ierr);
413   ierr = PetscOptionsEnd();CHKERRQ(ierr);
414 
415   /* convert matrix if needed */
416   if (Ain) {
417     PetscBool isseqaij;
418     ierr = PetscObjectTypeCompare((PetscObject)Ain,MATSEQAIJ,&isseqaij);CHKERRQ(ierr);
419     if (isseqaij) {
420       ierr = PetscObjectReference((PetscObject)Ain);CHKERRQ(ierr);
421       sub_schurs->A = Ain;
422     } else {
423       ierr = MatConvert(Ain,MATSEQAIJ,MAT_INITIAL_MATRIX,&sub_schurs->A);CHKERRQ(ierr);
424     }
425   }
426 
427   ierr = PetscObjectReference((PetscObject)Sin);CHKERRQ(ierr);
428   sub_schurs->S = Sin;
429   if (sub_schurs->schur_explicit) {
430     sub_schurs->schur_explicit = (PetscBool)(!!sub_schurs->A);
431   }
432 
433   /* preliminary checks */
434   if (!sub_schurs->schur_explicit && compute_Stilda) SETERRQ(PetscObjectComm((PetscObject)sub_schurs->l2gmap),PETSC_ERR_SUP,"Adaptive selection of constraints requires MUMPS and/or MKL_PARDISO");
435 
436   /* restrict work on active processes */
437   color = 0;
438   if (!sub_schurs->n_subs) color = 1; /* this can happen if we are in a multilevel case or if the subdomain is disconnected */
439   ierr = MPI_Comm_rank(PetscObjectComm((PetscObject)sub_schurs->l2gmap),&rank);CHKERRQ(ierr);
440   ierr = PetscSubcommCreate(PetscObjectComm((PetscObject)sub_schurs->l2gmap),&subcomm);CHKERRQ(ierr);
441   ierr = PetscSubcommSetNumber(subcomm,2);CHKERRQ(ierr);
442   ierr = PetscSubcommSetTypeGeneral(subcomm,color,rank);CHKERRQ(ierr);
443   ierr = PetscCommDuplicate(PetscSubcommChild(subcomm),&comm_n,NULL);CHKERRQ(ierr);
444   ierr = PetscSubcommDestroy(&subcomm);CHKERRQ(ierr);
445   if (!sub_schurs->n_subs) {
446     ierr = PetscCommDestroy(&comm_n);CHKERRQ(ierr);
447     PetscFunctionReturn(0);
448   }
449   /* ierr = PetscCommDuplicate(PetscObjectComm((PetscObject)sub_schurs->l2gmap),&comm_n,NULL);CHKERRQ(ierr); */
450 
451   /* get Schur complement matrices */
452   if (!sub_schurs->schur_explicit) {
453     Mat       tA_IB,tA_BI,tA_BB;
454     PetscBool isseqsbaij;
455     ierr = MatSchurComplementGetSubMatrices(sub_schurs->S,&A_II,NULL,&tA_IB,&tA_BI,&tA_BB);CHKERRQ(ierr);
456     ierr = PetscObjectTypeCompare((PetscObject)tA_BB,MATSEQSBAIJ,&isseqsbaij);CHKERRQ(ierr);
457     if (isseqsbaij) {
458       ierr = MatConvert(tA_BB,MATSEQAIJ,MAT_INITIAL_MATRIX,&A_BB);CHKERRQ(ierr);
459       ierr = MatConvert(tA_IB,MATSEQAIJ,MAT_INITIAL_MATRIX,&A_IB);CHKERRQ(ierr);
460       ierr = MatConvert(tA_BI,MATSEQAIJ,MAT_INITIAL_MATRIX,&A_BI);CHKERRQ(ierr);
461     } else {
462       ierr = PetscObjectReference((PetscObject)tA_BB);CHKERRQ(ierr);
463       A_BB = tA_BB;
464       ierr = PetscObjectReference((PetscObject)tA_IB);CHKERRQ(ierr);
465       A_IB = tA_IB;
466       ierr = PetscObjectReference((PetscObject)tA_BI);CHKERRQ(ierr);
467       A_BI = tA_BI;
468     }
469   } else {
470     A_II = NULL;
471     A_IB = NULL;
472     A_BI = NULL;
473     A_BB = NULL;
474   }
475   S_all = NULL;
476 
477   /* determine interior problems */
478   ierr = ISGetLocalSize(sub_schurs->is_I,&i);CHKERRQ(ierr);
479   if (nlayers >= 0 && i) { /* Interior problems can be different from the original one */
480     PetscBT                touched;
481     const PetscInt*        idx_B;
482     PetscInt               n_I,n_B,n_local_dofs,n_prev_added,j,layer,*local_numbering;
483 
484     if (!xadj) SETERRQ(PETSC_COMM_SELF,PETSC_ERR_PLIB,"Cannot request layering without adjacency");
485     /* get sizes */
486     ierr = ISGetLocalSize(sub_schurs->is_I,&n_I);CHKERRQ(ierr);
487     ierr = ISGetLocalSize(sub_schurs->is_B,&n_B);CHKERRQ(ierr);
488 
489     ierr = PetscMalloc1(n_I+n_B,&local_numbering);CHKERRQ(ierr);
490     ierr = PetscBTCreate(n_I+n_B,&touched);CHKERRQ(ierr);
491     ierr = PetscBTMemzero(n_I+n_B,touched);CHKERRQ(ierr);
492 
493     /* all boundary dofs must be skipped when adding layers */
494     ierr = ISGetIndices(sub_schurs->is_B,&idx_B);CHKERRQ(ierr);
495     for (j=0;j<n_B;j++) {
496       ierr = PetscBTSet(touched,idx_B[j]);CHKERRQ(ierr);
497     }
498     ierr = PetscMemcpy(local_numbering,idx_B,n_B*sizeof(PetscInt));CHKERRQ(ierr);
499     ierr = ISRestoreIndices(sub_schurs->is_B,&idx_B);CHKERRQ(ierr);
500 
501     /* add prescribed number of layers of dofs */
502     n_local_dofs = n_B;
503     n_prev_added = n_B;
504     for (layer=0;layer<nlayers;layer++) {
505       PetscInt n_added;
506       if (n_local_dofs == n_I+n_B) break;
507       if (n_local_dofs > n_I+n_B) SETERRQ3(PETSC_COMM_SELF,PETSC_ERR_PLIB,"Error querying layer %D. Out of bound access (%D > %D)",layer,n_local_dofs,n_I+n_B);
508       ierr = PCBDDCAdjGetNextLayer_Private(local_numbering+n_local_dofs,n_prev_added,touched,xadj,adjncy,&n_added);CHKERRQ(ierr);
509       n_prev_added = n_added;
510       n_local_dofs += n_added;
511       if (!n_added) break;
512     }
513     ierr = PetscBTDestroy(&touched);CHKERRQ(ierr);
514 
515     /* IS for I layer dofs in original numbering */
516     ierr = ISCreateGeneral(PetscObjectComm((PetscObject)sub_schurs->is_I),n_local_dofs-n_B,local_numbering+n_B,PETSC_COPY_VALUES,&is_I_layer);CHKERRQ(ierr);
517     ierr = PetscFree(local_numbering);CHKERRQ(ierr);
518     ierr = ISSort(is_I_layer);CHKERRQ(ierr);
519     /* IS for I layer dofs in I numbering */
520     if (!sub_schurs->schur_explicit) {
521       ISLocalToGlobalMapping ItoNmap;
522       ierr = ISLocalToGlobalMappingCreateIS(sub_schurs->is_I,&ItoNmap);CHKERRQ(ierr);
523       ierr = ISGlobalToLocalMappingApplyIS(ItoNmap,IS_GTOLM_DROP,is_I_layer,&is_I);CHKERRQ(ierr);
524       ierr = ISLocalToGlobalMappingDestroy(&ItoNmap);CHKERRQ(ierr);
525 
526       /* II block */
527       ierr = MatCreateSubMatrix(A_II,is_I,is_I,MAT_INITIAL_MATRIX,&AE_II);CHKERRQ(ierr);
528     }
529   } else {
530     PetscInt n_I;
531 
532     /* IS for I dofs in original numbering */
533     ierr = PetscObjectReference((PetscObject)sub_schurs->is_I);CHKERRQ(ierr);
534     is_I_layer = sub_schurs->is_I;
535 
536     /* IS for I dofs in I numbering (strided 1) */
537     if (!sub_schurs->schur_explicit) {
538       ierr = ISGetSize(sub_schurs->is_I,&n_I);CHKERRQ(ierr);
539       ierr = ISCreateStride(PetscObjectComm((PetscObject)sub_schurs->is_I),n_I,0,1,&is_I);CHKERRQ(ierr);
540 
541       /* II block is the same */
542       ierr = PetscObjectReference((PetscObject)A_II);CHKERRQ(ierr);
543       AE_II = A_II;
544     }
545   }
546 
547   /* Get info on subset sizes and sum of all subsets sizes */
548   max_subset_size = 0;
549   local_size = 0;
550   for (i=0;i<sub_schurs->n_subs;i++) {
551     ierr = ISGetLocalSize(sub_schurs->is_subs[i],&subset_size);CHKERRQ(ierr);
552     max_subset_size = PetscMax(subset_size,max_subset_size);
553     local_size += subset_size;
554   }
555 
556   /* Work arrays for local indices */
557   extra = 0;
558   ierr = ISGetLocalSize(sub_schurs->is_B,&n_B);CHKERRQ(ierr);
559   if (sub_schurs->schur_explicit && is_I_layer) {
560     ierr = ISGetLocalSize(is_I_layer,&extra);CHKERRQ(ierr);
561   }
562   ierr = PetscMalloc1(n_B+extra,&all_local_idx_N);CHKERRQ(ierr);
563   if (extra) {
564     const PetscInt *idxs;
565     ierr = ISGetIndices(is_I_layer,&idxs);CHKERRQ(ierr);
566     ierr = PetscMemcpy(all_local_idx_N,idxs,extra*sizeof(PetscInt));CHKERRQ(ierr);
567     ierr = ISRestoreIndices(is_I_layer,&idxs);CHKERRQ(ierr);
568   }
569   ierr = PetscMalloc1(local_size,&nnz);CHKERRQ(ierr);
570   ierr = PetscMalloc1(sub_schurs->n_subs,&auxnum1);CHKERRQ(ierr);
571   ierr = PetscMalloc1(sub_schurs->n_subs,&auxnum2);CHKERRQ(ierr);
572 
573   /* Get local indices in local numbering */
574   local_size = 0;
575   for (i=0;i<sub_schurs->n_subs;i++) {
576     PetscInt j;
577     const    PetscInt *idxs;
578 
579     ierr = ISGetLocalSize(sub_schurs->is_subs[i],&subset_size);CHKERRQ(ierr);
580     ierr = ISGetIndices(sub_schurs->is_subs[i],&idxs);CHKERRQ(ierr);
581     /* start (smallest in global ordering) and multiplicity */
582     auxnum1[i] = idxs[0];
583     auxnum2[i] = subset_size;
584     /* subset indices in local numbering */
585     ierr = PetscMemcpy(all_local_idx_N+local_size+extra,idxs,subset_size*sizeof(PetscInt));CHKERRQ(ierr);
586     ierr = ISRestoreIndices(sub_schurs->is_subs[i],&idxs);CHKERRQ(ierr);
587     for (j=0;j<subset_size;j++) nnz[local_size+j] = subset_size;
588     local_size += subset_size;
589   }
590 
591   /* allocate extra workspace needed only for GETRI */
592   if (local_size && !benign_trick && (!sub_schurs->is_hermitian || !sub_schurs->is_posdef)) {
593     PetscScalar  lwork,dummyscalar = 0.;
594     PetscBLASInt dummyint = 0;
595 
596     use_getr = PETSC_TRUE;
597     B_lwork = -1;
598     ierr = PetscBLASIntCast(local_size,&B_N);CHKERRQ(ierr);
599     ierr = PetscFPTrapPush(PETSC_FP_TRAP_OFF);CHKERRQ(ierr);
600     PetscStackCallBLAS("LAPACKgetri",LAPACKgetri_(&B_N,&dummyscalar,&B_N,&dummyint,&lwork,&B_lwork,&B_ierr));
601     ierr = PetscFPTrapPop();CHKERRQ(ierr);
602     if (B_ierr) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in query to GETRI Lapack routine %d",(int)B_ierr);
603     ierr = PetscBLASIntCast((PetscInt)PetscRealPart(lwork),&B_lwork);CHKERRQ(ierr);
604     ierr = PetscMalloc2(B_lwork,&Bwork,B_N,&pivots);CHKERRQ(ierr);
605   } else {
606     Bwork = NULL;
607     pivots = NULL;
608   }
609 
610   /* prepare parallel matrices for summing up properly schurs on subsets */
611   ierr = ISCreateGeneral(comm_n,sub_schurs->n_subs,auxnum1,PETSC_OWN_POINTER,&all_subsets_n);CHKERRQ(ierr);
612   ierr = ISLocalToGlobalMappingApplyIS(sub_schurs->l2gmap,all_subsets_n,&all_subsets);CHKERRQ(ierr);
613   ierr = ISDestroy(&all_subsets_n);CHKERRQ(ierr);
614   ierr = ISCreateGeneral(comm_n,sub_schurs->n_subs,auxnum2,PETSC_OWN_POINTER,&all_subsets_mult);CHKERRQ(ierr);
615   ierr = ISRenumber(all_subsets,all_subsets_mult,&global_size,&all_subsets_n);CHKERRQ(ierr);
616   ierr = ISDestroy(&all_subsets);CHKERRQ(ierr);
617   ierr = ISDestroy(&all_subsets_mult);CHKERRQ(ierr);
618   ierr = ISGetLocalSize(all_subsets_n,&i);CHKERRQ(ierr);
619   if (i != local_size) SETERRQ2(PETSC_COMM_SELF,PETSC_ERR_PLIB,"Invalid size of new subset! %D != %D",i,local_size);
620   ierr = ISLocalToGlobalMappingCreateIS(all_subsets_n,&l2gmap_subsets);CHKERRQ(ierr);
621   ierr = MatCreateIS(comm_n,1,PETSC_DECIDE,PETSC_DECIDE,global_size,global_size,l2gmap_subsets,NULL,&work_mat);CHKERRQ(ierr);
622   ierr = ISLocalToGlobalMappingDestroy(&l2gmap_subsets);CHKERRQ(ierr);
623   ierr = MatCreate(PetscObjectComm((PetscObject)work_mat),&global_schur_subsets);CHKERRQ(ierr);
624   ierr = MatSetSizes(global_schur_subsets,PETSC_DECIDE,PETSC_DECIDE,global_size,global_size);CHKERRQ(ierr);
625   ierr = MatSetType(global_schur_subsets,MATMPIAIJ);CHKERRQ(ierr);
626 
627   /* subset indices in local boundary numbering */
628   if (!sub_schurs->is_Ej_all) {
629     PetscInt *all_local_idx_B;
630 
631     ierr = PetscMalloc1(local_size,&all_local_idx_B);CHKERRQ(ierr);
632     ierr = ISGlobalToLocalMappingApply(sub_schurs->BtoNmap,IS_GTOLM_DROP,local_size,all_local_idx_N+extra,&subset_size,all_local_idx_B);CHKERRQ(ierr);
633     if (subset_size != local_size) SETERRQ2(PETSC_COMM_SELF,PETSC_ERR_PLIB,"Error in sub_schurs serial (BtoNmap)! %D != %D\n",subset_size,local_size);
634     ierr = ISCreateGeneral(PETSC_COMM_SELF,local_size,all_local_idx_B,PETSC_OWN_POINTER,&sub_schurs->is_Ej_all);CHKERRQ(ierr);
635   }
636 
637   if (change) {
638     ISLocalToGlobalMapping BtoS;
639     IS                     change_primal_B;
640     IS                     change_primal_all;
641 
642     if (sub_schurs->change_primal_sub) SETERRQ(PETSC_COMM_SELF,PETSC_ERR_PLIB,"This should not happen");
643     if (sub_schurs->change) SETERRQ(PETSC_COMM_SELF,PETSC_ERR_PLIB,"This should not happen");
644     ierr = PetscMalloc1(sub_schurs->n_subs,&sub_schurs->change_primal_sub);CHKERRQ(ierr);
645     for (i=0;i<sub_schurs->n_subs;i++) {
646       ISLocalToGlobalMapping NtoS;
647       ierr = ISLocalToGlobalMappingCreateIS(sub_schurs->is_subs[i],&NtoS);CHKERRQ(ierr);
648       ierr = ISGlobalToLocalMappingApplyIS(NtoS,IS_GTOLM_DROP,change_primal,&sub_schurs->change_primal_sub[i]);CHKERRQ(ierr);
649       ierr = ISLocalToGlobalMappingDestroy(&NtoS);CHKERRQ(ierr);
650     }
651     ierr = ISGlobalToLocalMappingApplyIS(sub_schurs->BtoNmap,IS_GTOLM_DROP,change_primal,&change_primal_B);CHKERRQ(ierr);
652     ierr = ISLocalToGlobalMappingCreateIS(sub_schurs->is_Ej_all,&BtoS);CHKERRQ(ierr);
653     ierr = ISGlobalToLocalMappingApplyIS(BtoS,IS_GTOLM_DROP,change_primal_B,&change_primal_all);CHKERRQ(ierr);
654     ierr = ISLocalToGlobalMappingDestroy(&BtoS);CHKERRQ(ierr);
655     ierr = ISDestroy(&change_primal_B);CHKERRQ(ierr);
656     ierr = PetscMalloc1(sub_schurs->n_subs,&sub_schurs->change);CHKERRQ(ierr);
657     for (i=0;i<sub_schurs->n_subs;i++) {
658       Mat change_sub;
659 
660       ierr = ISGetLocalSize(sub_schurs->is_subs[i],&subset_size);CHKERRQ(ierr);
661       ierr = KSPCreate(PETSC_COMM_SELF,&sub_schurs->change[i]);CHKERRQ(ierr);
662       ierr = KSPSetType(sub_schurs->change[i],KSPPREONLY);CHKERRQ(ierr);
663       if (!sub_schurs->change_with_qr) {
664         ierr = MatCreateSubMatrix(change,sub_schurs->is_subs[i],sub_schurs->is_subs[i],MAT_INITIAL_MATRIX,&change_sub);CHKERRQ(ierr);
665       } else {
666         Mat change_subt;
667         ierr = MatCreateSubMatrix(change,sub_schurs->is_subs[i],sub_schurs->is_subs[i],MAT_INITIAL_MATRIX,&change_subt);CHKERRQ(ierr);
668         ierr = MatConvert(change_subt,MATSEQDENSE,MAT_INITIAL_MATRIX,&change_sub);CHKERRQ(ierr);
669         ierr = MatDestroy(&change_subt);CHKERRQ(ierr);
670       }
671       ierr = KSPSetOperators(sub_schurs->change[i],change_sub,change_sub);CHKERRQ(ierr);
672       ierr = MatDestroy(&change_sub);CHKERRQ(ierr);
673       ierr = KSPSetOptionsPrefix(sub_schurs->change[i],sub_schurs->prefix);CHKERRQ(ierr);
674       ierr = KSPAppendOptionsPrefix(sub_schurs->change[i],"sub_schurs_change_");CHKERRQ(ierr);
675     }
676     ierr = ISDestroy(&change_primal_all);CHKERRQ(ierr);
677   }
678 
679   /* Local matrix of all local Schur on subsets (transposed) */
680   if (!sub_schurs->S_Ej_all) {
681     ierr = MatCreate(PETSC_COMM_SELF,&sub_schurs->S_Ej_all);CHKERRQ(ierr);
682     ierr = MatSetSizes(sub_schurs->S_Ej_all,PETSC_DECIDE,PETSC_DECIDE,local_size,local_size);CHKERRQ(ierr);
683     ierr = MatSetType(sub_schurs->S_Ej_all,MATAIJ);CHKERRQ(ierr);
684     ierr = MatSeqAIJSetPreallocation(sub_schurs->S_Ej_all,0,nnz);CHKERRQ(ierr);
685   }
686 
687   /* Compute Schur complements explicitly */
688   F = NULL;
689   if (!sub_schurs->schur_explicit) { /* this code branch is used when MatFactor with Schur complemnent support is not present; it is not very efficient, unless the economic version of the scaling is required */
690     Mat         S_Ej_expl;
691     PetscScalar *work;
692     PetscInt    j,*dummy_idx;
693     PetscBool   Sdense;
694 
695     ierr = PetscMalloc2(max_subset_size,&dummy_idx,max_subset_size*max_subset_size,&work);CHKERRQ(ierr);
696     local_size = 0;
697     for (i=0;i<sub_schurs->n_subs;i++) {
698       IS  is_subset_B;
699       Mat AE_EE,AE_IE,AE_EI,S_Ej;
700 
701       /* subsets in original and boundary numbering */
702       ierr = ISGlobalToLocalMappingApplyIS(sub_schurs->BtoNmap,IS_GTOLM_DROP,sub_schurs->is_subs[i],&is_subset_B);CHKERRQ(ierr);
703       /* EE block */
704       ierr = MatCreateSubMatrix(A_BB,is_subset_B,is_subset_B,MAT_INITIAL_MATRIX,&AE_EE);CHKERRQ(ierr);
705       /* IE block */
706       ierr = MatCreateSubMatrix(A_IB,is_I,is_subset_B,MAT_INITIAL_MATRIX,&AE_IE);CHKERRQ(ierr);
707       /* EI block */
708       if (sub_schurs->is_hermitian) {
709         ierr = MatCreateTranspose(AE_IE,&AE_EI);CHKERRQ(ierr);
710       } else {
711         ierr = MatCreateSubMatrix(A_BI,is_subset_B,is_I,MAT_INITIAL_MATRIX,&AE_EI);CHKERRQ(ierr);
712       }
713       ierr = ISDestroy(&is_subset_B);CHKERRQ(ierr);
714       ierr = MatCreateSchurComplement(AE_II,AE_II,AE_IE,AE_EI,AE_EE,&S_Ej);CHKERRQ(ierr);
715       ierr = MatDestroy(&AE_EE);CHKERRQ(ierr);
716       ierr = MatDestroy(&AE_IE);CHKERRQ(ierr);
717       ierr = MatDestroy(&AE_EI);CHKERRQ(ierr);
718       if (AE_II == A_II) { /* we can reuse the same ksp */
719         KSP ksp;
720         ierr = MatSchurComplementGetKSP(sub_schurs->S,&ksp);CHKERRQ(ierr);
721         ierr = MatSchurComplementSetKSP(S_Ej,ksp);CHKERRQ(ierr);
722       } else { /* build new ksp object which inherits ksp and pc types from the original one */
723         KSP       origksp,schurksp;
724         PC        origpc,schurpc;
725         KSPType   ksp_type;
726         PetscInt  n_internal;
727         PetscBool ispcnone;
728 
729         ierr = MatSchurComplementGetKSP(sub_schurs->S,&origksp);CHKERRQ(ierr);
730         ierr = MatSchurComplementGetKSP(S_Ej,&schurksp);CHKERRQ(ierr);
731         ierr = KSPGetType(origksp,&ksp_type);CHKERRQ(ierr);
732         ierr = KSPSetType(schurksp,ksp_type);CHKERRQ(ierr);
733         ierr = KSPGetPC(schurksp,&schurpc);CHKERRQ(ierr);
734         ierr = KSPGetPC(origksp,&origpc);CHKERRQ(ierr);
735         ierr = PetscObjectTypeCompare((PetscObject)origpc,PCNONE,&ispcnone);CHKERRQ(ierr);
736         if (!ispcnone) {
737           PCType pc_type;
738           ierr = PCGetType(origpc,&pc_type);CHKERRQ(ierr);
739           ierr = PCSetType(schurpc,pc_type);CHKERRQ(ierr);
740         } else {
741           ierr = PCSetType(schurpc,PCLU);CHKERRQ(ierr);
742         }
743         ierr = ISGetSize(is_I,&n_internal);CHKERRQ(ierr);
744         if (n_internal) { /* UMFPACK gives error with 0 sized problems */
745           MatSolverPackage solver=NULL;
746           ierr = PCFactorGetMatSolverPackage(origpc,(const MatSolverPackage*)&solver);CHKERRQ(ierr);
747           if (solver) {
748             ierr = PCFactorSetMatSolverPackage(schurpc,solver);CHKERRQ(ierr);
749           }
750         }
751         ierr = KSPSetUp(schurksp);CHKERRQ(ierr);
752       }
753       ierr = ISGetLocalSize(sub_schurs->is_subs[i],&subset_size);CHKERRQ(ierr);
754       ierr = MatCreateSeqDense(PETSC_COMM_SELF,subset_size,subset_size,work,&S_Ej_expl);CHKERRQ(ierr);
755       ierr = PCBDDCComputeExplicitSchur(S_Ej,sub_schurs->is_hermitian,MAT_REUSE_MATRIX,&S_Ej_expl);CHKERRQ(ierr);
756       ierr = PetscObjectTypeCompare((PetscObject)S_Ej_expl,MATSEQDENSE,&Sdense);CHKERRQ(ierr);
757       if (Sdense) {
758         for (j=0;j<subset_size;j++) {
759           dummy_idx[j]=local_size+j;
760         }
761         ierr = MatSetValues(sub_schurs->S_Ej_all,subset_size,dummy_idx,subset_size,dummy_idx,work,INSERT_VALUES);CHKERRQ(ierr);
762       } else SETERRQ(PETSC_COMM_SELF,PETSC_ERR_SUP,"Not yet implemented for sparse matrices");
763       ierr = MatDestroy(&S_Ej);CHKERRQ(ierr);
764       ierr = MatDestroy(&S_Ej_expl);CHKERRQ(ierr);
765       local_size += subset_size;
766     }
767     ierr = PetscFree2(dummy_idx,work);CHKERRQ(ierr);
768     /* free */
769     ierr = ISDestroy(&is_I);CHKERRQ(ierr);
770     ierr = MatDestroy(&AE_II);CHKERRQ(ierr);
771     ierr = PetscFree(all_local_idx_N);CHKERRQ(ierr);
772   } else {
773     Mat         A,cs_AIB_mat = NULL,benign_AIIm1_ones_mat = NULL;
774     Vec         Dall = NULL;
775     IS          is_A_all,*is_p_r = NULL;
776     PetscScalar *work,*S_data,*schur_factor,infty = PETSC_MAX_REAL;
777     PetscInt    n,n_I,*dummy_idx,size_schur,size_active_schur,cum,cum2;
778     PetscBool   economic,solver_S,S_lower_triangular = PETSC_FALSE;
779     PetscBool   schur_has_vertices,factor_workaround;
780     char        solver[256];
781 
782     /* get sizes */
783     n_I = 0;
784     if (is_I_layer) {
785       ierr = ISGetLocalSize(is_I_layer,&n_I);CHKERRQ(ierr);
786     }
787     economic = PETSC_FALSE;
788     ierr = ISGetLocalSize(sub_schurs->is_I,&cum);CHKERRQ(ierr);
789     if (cum != n_I) economic = PETSC_TRUE;
790     ierr = MatGetLocalSize(sub_schurs->A,&n,NULL);CHKERRQ(ierr);
791     size_active_schur = local_size;
792 
793     /* import scaling vector (wrong formulation if we have 3D edges) */
794     if (scaling && compute_Stilda) {
795       const PetscScalar *array;
796       PetscScalar       *array2;
797       const PetscInt    *idxs;
798       PetscInt          i;
799 
800       ierr = ISGetIndices(sub_schurs->is_Ej_all,&idxs);CHKERRQ(ierr);
801       ierr = VecCreateSeq(PETSC_COMM_SELF,size_active_schur,&Dall);CHKERRQ(ierr);
802       ierr = VecGetArrayRead(scaling,&array);CHKERRQ(ierr);
803       ierr = VecGetArray(Dall,&array2);CHKERRQ(ierr);
804       for (i=0;i<size_active_schur;i++) array2[i] = array[idxs[i]];
805       ierr = VecRestoreArray(Dall,&array2);CHKERRQ(ierr);
806       ierr = VecRestoreArrayRead(scaling,&array);CHKERRQ(ierr);
807       ierr = ISRestoreIndices(sub_schurs->is_Ej_all,&idxs);CHKERRQ(ierr);
808       deluxe = PETSC_FALSE;
809     }
810 
811     /* size active schurs does not count any dirichlet or vertex dof on the interface */
812     factor_workaround = PETSC_FALSE;
813     schur_has_vertices = PETSC_FALSE;
814     cum = n_I+size_active_schur;
815     if (sub_schurs->is_dir) {
816       const PetscInt* idxs;
817       PetscInt        n_dir;
818 
819       ierr = ISGetLocalSize(sub_schurs->is_dir,&n_dir);CHKERRQ(ierr);
820       ierr = ISGetIndices(sub_schurs->is_dir,&idxs);CHKERRQ(ierr);
821       ierr = PetscMemcpy(all_local_idx_N+cum,idxs,n_dir*sizeof(PetscInt));CHKERRQ(ierr);
822       ierr = ISRestoreIndices(sub_schurs->is_dir,&idxs);CHKERRQ(ierr);
823       cum += n_dir;
824       factor_workaround = PETSC_TRUE;
825     }
826     /* include the primal vertices in the Schur complement */
827     if (exact_schur && sub_schurs->is_vertices && (compute_Stilda || benign_n)) {
828       PetscInt n_v;
829 
830       ierr = ISGetLocalSize(sub_schurs->is_vertices,&n_v);CHKERRQ(ierr);
831       if (n_v) {
832         const PetscInt* idxs;
833 
834         ierr = ISGetIndices(sub_schurs->is_vertices,&idxs);CHKERRQ(ierr);
835         ierr = PetscMemcpy(all_local_idx_N+cum,idxs,n_v*sizeof(PetscInt));CHKERRQ(ierr);
836         ierr = ISRestoreIndices(sub_schurs->is_vertices,&idxs);CHKERRQ(ierr);
837         cum += n_v;
838         factor_workaround = PETSC_TRUE;
839         schur_has_vertices = PETSC_TRUE;
840       }
841     }
842     size_schur = cum - n_I;
843     ierr = ISCreateGeneral(PETSC_COMM_SELF,cum,all_local_idx_N,PETSC_OWN_POINTER,&is_A_all);CHKERRQ(ierr);
844     /* get working mat (TODO: factorize without actually permuting)  */
845     if (cum == n) {
846       ierr = ISSetPermutation(is_A_all);CHKERRQ(ierr);
847       ierr = MatPermute(sub_schurs->A,is_A_all,is_A_all,&A);CHKERRQ(ierr);
848     } else {
849       ierr = MatCreateSubMatrix(sub_schurs->A,is_A_all,is_A_all,MAT_INITIAL_MATRIX,&A);CHKERRQ(ierr);
850     }
851     ierr = MatSetOptionsPrefix(A,sub_schurs->prefix);CHKERRQ(ierr);
852     ierr = MatAppendOptionsPrefix(A,"sub_schurs_");CHKERRQ(ierr);
853 
854     /* if we actually change the basis for the pressures, LDL^T factors will use a lot of memory
855        n^2 instead of n^1.5 or something. This is a workaround */
856     if (benign_n) {
857       Vec                    v;
858       ISLocalToGlobalMapping N_to_reor;
859       IS                     is_p0,is_p0_p;
860       PetscScalar            *cs_AIB,*AIIm1_data;
861       PetscInt               sizeA;
862 
863       ierr = ISLocalToGlobalMappingCreateIS(is_A_all,&N_to_reor);CHKERRQ(ierr);
864       ierr = ISCreateGeneral(PETSC_COMM_SELF,benign_n,benign_p0_lidx,PETSC_COPY_VALUES,&is_p0);CHKERRQ(ierr);
865       ierr = ISGlobalToLocalMappingApplyIS(N_to_reor,IS_GTOLM_DROP,is_p0,&is_p0_p);CHKERRQ(ierr);
866       ierr = ISDestroy(&is_p0);CHKERRQ(ierr);
867       ierr = MatCreateVecs(A,&v,NULL);CHKERRQ(ierr);
868       ierr = VecGetSize(v,&sizeA);CHKERRQ(ierr);
869       ierr = MatCreateSeqDense(PETSC_COMM_SELF,sizeA,benign_n,NULL,&benign_AIIm1_ones_mat);CHKERRQ(ierr);
870       ierr = MatCreateSeqDense(PETSC_COMM_SELF,size_schur,benign_n,NULL,&cs_AIB_mat);CHKERRQ(ierr);
871       ierr = MatDenseGetArray(cs_AIB_mat,&cs_AIB);CHKERRQ(ierr);
872       ierr = MatDenseGetArray(benign_AIIm1_ones_mat,&AIIm1_data);CHKERRQ(ierr);
873       ierr = PetscMalloc1(benign_n,&is_p_r);CHKERRQ(ierr);
874       /* compute colsum of A_IB restricted to pressures */
875       for (i=0;i<benign_n;i++) {
876         Vec            benign_AIIm1_ones;
877         PetscScalar    *array;
878         const PetscInt *idxs;
879         PetscInt       j,nz;
880 
881         ierr = ISGlobalToLocalMappingApplyIS(N_to_reor,IS_GTOLM_DROP,benign_zerodiag_subs[i],&is_p_r[i]);CHKERRQ(ierr);
882         ierr = ISGetLocalSize(is_p_r[i],&nz);CHKERRQ(ierr);
883         ierr = ISGetIndices(is_p_r[i],&idxs);CHKERRQ(ierr);
884         for (j=0;j<nz;j++) AIIm1_data[idxs[j]+sizeA*i] = 1.;
885         ierr = ISRestoreIndices(is_p_r[i],&idxs);CHKERRQ(ierr);
886         ierr = VecCreateSeqWithArray(PETSC_COMM_SELF,1,sizeA,AIIm1_data+sizeA*i,&benign_AIIm1_ones);CHKERRQ(ierr);
887         ierr = MatMult(A,benign_AIIm1_ones,v);CHKERRQ(ierr);
888         ierr = VecDestroy(&benign_AIIm1_ones);CHKERRQ(ierr);
889         ierr = VecGetArray(v,&array);CHKERRQ(ierr);
890         for (j=0;j<size_schur;j++) {
891 #if defined(PETSC_USE_COMPLEX)
892           cs_AIB[i*size_schur + j] = (PetscRealPart(array[j+n_I])/nz + PETSC_i*(PetscImaginaryPart(array[j+n_I])/nz));
893 #else
894           cs_AIB[i*size_schur + j] = array[j+n_I]/nz;
895 #endif
896         }
897         ierr = VecRestoreArray(v,&array);CHKERRQ(ierr);
898       }
899       ierr = MatDenseRestoreArray(cs_AIB_mat,&cs_AIB);CHKERRQ(ierr);
900       ierr = MatDenseRestoreArray(benign_AIIm1_ones_mat,&AIIm1_data);CHKERRQ(ierr);
901       ierr = VecDestroy(&v);CHKERRQ(ierr);
902       ierr = MatSetOption(A,MAT_KEEP_NONZERO_PATTERN,PETSC_FALSE);CHKERRQ(ierr);
903       ierr = MatSetOption(A,MAT_NEW_NONZERO_LOCATION_ERR,PETSC_FALSE);CHKERRQ(ierr);
904       ierr = MatSetOption(A,MAT_NEW_NONZERO_ALLOCATION_ERR,PETSC_FALSE);CHKERRQ(ierr);
905       ierr = MatZeroRowsColumnsIS(A,is_p0_p,1.0,NULL,NULL);CHKERRQ(ierr);
906       ierr = ISDestroy(&is_p0_p);CHKERRQ(ierr);
907       ierr = ISLocalToGlobalMappingDestroy(&N_to_reor);CHKERRQ(ierr);
908     }
909     ierr = MatSetOption(A,MAT_SYMMETRIC,sub_schurs->is_hermitian);CHKERRQ(ierr);
910     ierr = MatSetOption(A,MAT_HERMITIAN,sub_schurs->is_hermitian);CHKERRQ(ierr);
911     ierr = MatSetOption(A,MAT_SPD,sub_schurs->is_posdef);CHKERRQ(ierr);
912 #if defined(PETSC_HAVE_MUMPS)
913     ierr = PetscStrcpy(solver,MATSOLVERMUMPS);CHKERRQ(ierr);
914 #else
915     ierr = PetscStrcpy(solver,MATSOLVERMKL_PARDISO);CHKERRQ(ierr);
916 #endif
917     ierr = PetscOptionsGetString(NULL,((PetscObject)A)->prefix,"-mat_solver_package",solver,256,NULL);CHKERRQ(ierr);
918 
919     /* when using the benign subspace trick, the local Schur complements are SPD */
920     if (benign_trick) sub_schurs->is_posdef = PETSC_TRUE;
921 
922     if (n_I) { /* TODO add ordering from options */
923       IS is_schur;
924 
925       if (sub_schurs->is_hermitian && sub_schurs->is_posdef) {
926         ierr = MatGetFactor(A,solver,MAT_FACTOR_CHOLESKY,&F);CHKERRQ(ierr);
927       } else {
928         ierr = MatGetFactor(A,solver,MAT_FACTOR_LU,&F);CHKERRQ(ierr);
929       }
930       ierr = MatSetErrorIfFailure(A,PETSC_TRUE);CHKERRQ(ierr);
931 
932       /* subsets ordered last */
933       ierr = ISCreateStride(PETSC_COMM_SELF,size_schur,n_I,1,&is_schur);CHKERRQ(ierr);
934       ierr = MatFactorSetSchurIS(F,is_schur);CHKERRQ(ierr);
935       ierr = ISDestroy(&is_schur);CHKERRQ(ierr);
936 
937       /* factorization step */
938       if (sub_schurs->is_hermitian && sub_schurs->is_posdef) {
939         ierr = MatCholeskyFactorSymbolic(F,A,NULL,NULL);CHKERRQ(ierr);
940 #if defined(PETSC_HAVE_MUMPS) /* be sure that icntl 19 is not set by command line */
941         ierr = MatMumpsSetIcntl(F,19,2);CHKERRQ(ierr);
942 #endif
943         ierr = MatCholeskyFactorNumeric(F,A,NULL);CHKERRQ(ierr);
944         S_lower_triangular = PETSC_TRUE;
945       } else {
946         ierr = MatLUFactorSymbolic(F,A,NULL,NULL,NULL);CHKERRQ(ierr);
947 #if defined(PETSC_HAVE_MUMPS) /* be sure that icntl 19 is not set by command line */
948         ierr = MatMumpsSetIcntl(F,19,3);CHKERRQ(ierr);
949 #endif
950         ierr = MatLUFactorNumeric(F,A,NULL);CHKERRQ(ierr);
951       }
952       ierr = MatViewFromOptions(F,(PetscObject)A,"-mat_factor_view");CHKERRQ(ierr);
953 
954       /* get explicit Schur Complement computed during numeric factorization */
955       ierr = MatFactorGetSchurComplement(F,&S_all,NULL);CHKERRQ(ierr);
956       ierr = MatSetOption(S_all,MAT_SPD,sub_schurs->is_posdef);CHKERRQ(ierr);
957       ierr = MatSetOption(S_all,MAT_HERMITIAN,sub_schurs->is_hermitian);CHKERRQ(ierr);
958 
959       /* we can reuse the solvers if we are not using the economic version */
960       reuse_solvers = (PetscBool)(reuse_solvers && !economic);
961       factor_workaround = (PetscBool)(reuse_solvers && factor_workaround);
962       if (!sub_schurs->is_posdef && factor_workaround && compute_Stilda && size_active_schur)
963         reuse_solvers = factor_workaround = PETSC_FALSE;
964 
965       solver_S = PETSC_TRUE;
966 
967       /* update the Schur complement with the change of basis on the pressures */
968       if (benign_n) {
969         PetscScalar *S_data,*cs_AIB,*AIIm1_data;
970         Vec         v;
971         PetscInt    sizeA;
972 
973         ierr = MatDenseGetArray(S_all,&S_data);CHKERRQ(ierr);
974         ierr = MatCreateVecs(A,&v,NULL);CHKERRQ(ierr);
975         ierr = VecGetSize(v,&sizeA);CHKERRQ(ierr);
976 #if defined(PETSC_HAVE_MUMPS)
977         ierr = MatMumpsSetIcntl(F,26,0);CHKERRQ(ierr);
978 #endif
979 #if defined(PETSC_HAVE_MKL_PARDISO)
980         ierr = MatMkl_PardisoSetCntl(F,70,1);CHKERRQ(ierr);
981 #endif
982         ierr = MatDenseGetArray(cs_AIB_mat,&cs_AIB);CHKERRQ(ierr);
983         ierr = MatDenseGetArray(benign_AIIm1_ones_mat,&AIIm1_data);CHKERRQ(ierr);
984         for (i=0;i<benign_n;i++) {
985           Vec            benign_AIIm1_ones;
986           PetscScalar    *array,sum = 0.,one = 1.;
987           const PetscInt *idxs;
988           PetscInt       j,nz;
989           PetscBLASInt   B_k,B_n;
990 
991           ierr = VecCreateSeqWithArray(PETSC_COMM_SELF,1,sizeA,AIIm1_data+sizeA*i,&benign_AIIm1_ones);CHKERRQ(ierr);
992           ierr = VecCopy(benign_AIIm1_ones,v);CHKERRQ(ierr);
993           ierr = MatSolve(F,v,benign_AIIm1_ones);CHKERRQ(ierr);
994           ierr = ISGetLocalSize(is_p_r[i],&nz);CHKERRQ(ierr);
995           ierr = ISGetIndices(is_p_r[i],&idxs);CHKERRQ(ierr);
996           /* p0 dof (eliminated) is excluded from the sum */
997           for (j=0;j<nz-1;j++) sum -= AIIm1_data[idxs[j]+sizeA*i];
998           ierr = ISRestoreIndices(is_p_r[i],&idxs);CHKERRQ(ierr);
999           ierr = MatMult(A,benign_AIIm1_ones,v);CHKERRQ(ierr);
1000           ierr = VecGetArray(v,&array);CHKERRQ(ierr);
1001           /* perform sparse rank updates on symmetric Schur (TODO: move outside of the loop?) */
1002           /* cs_AIB already scaled by 1./nz */
1003           B_k = 1;
1004           ierr = PetscBLASIntCast(size_schur,&B_n);CHKERRQ(ierr);
1005           PetscStackCallBLAS("BLASsyrk",BLASsyrk_("L","N",&B_n,&B_k,&sum,cs_AIB+i*size_schur,&B_n,&one,S_data,&B_n));
1006           sum  = 1.;
1007           PetscStackCallBLAS("BLASsyr2k",BLASsyr2k_("L","N",&B_n,&B_k,&sum,array+n_I,&B_n,cs_AIB+i*size_schur,&B_n,&one,S_data,&B_n));
1008           ierr = VecRestoreArray(v,&array);CHKERRQ(ierr);
1009           /* set p0 entry of AIIm1_ones to zero */
1010           ierr = ISGetIndices(is_p_r[i],&idxs);CHKERRQ(ierr);
1011           for (j=0;j<benign_n;j++) AIIm1_data[idxs[nz-1]+sizeA*j] = 0.;
1012           ierr = ISRestoreIndices(is_p_r[i],&idxs);CHKERRQ(ierr);
1013           ierr = VecDestroy(&benign_AIIm1_ones);CHKERRQ(ierr);
1014         }
1015         if (!S_lower_triangular) { /* I need to expand the upper triangular data (column oriented) */
1016           PetscInt k,j;
1017           for (k=0;k<size_schur;k++) {
1018             for (j=k;j<size_schur;j++) {
1019               S_data[j*size_schur+k] = PetscConj(S_data[k*size_schur+j]);
1020             }
1021           }
1022         }
1023 
1024         /* restore defaults */
1025 #if defined(PETSC_HAVE_MUMPS)
1026         ierr = MatMumpsSetIcntl(F,26,-1);CHKERRQ(ierr);
1027 #endif
1028 #if defined(PETSC_HAVE_MKL_PARDISO)
1029         ierr = MatMkl_PardisoSetCntl(F,70,0);CHKERRQ(ierr);
1030 #endif
1031         ierr = MatDenseRestoreArray(cs_AIB_mat,&cs_AIB);CHKERRQ(ierr);
1032         ierr = MatDenseRestoreArray(benign_AIIm1_ones_mat,&AIIm1_data);CHKERRQ(ierr);
1033         ierr = VecDestroy(&v);CHKERRQ(ierr);
1034         ierr = MatDenseRestoreArray(S_all,&S_data);CHKERRQ(ierr);
1035       }
1036       if (!reuse_solvers) {
1037         for (i=0;i<benign_n;i++) {
1038           ierr = ISDestroy(&is_p_r[i]);CHKERRQ(ierr);
1039         }
1040         ierr = PetscFree(is_p_r);CHKERRQ(ierr);
1041         ierr = MatDestroy(&cs_AIB_mat);CHKERRQ(ierr);
1042         ierr = MatDestroy(&benign_AIIm1_ones_mat);CHKERRQ(ierr);
1043       }
1044     } else { /* we can't use MatFactor when size_schur == size_of_the_problem */
1045       ierr = MatConvert(A,MATSEQDENSE,MAT_INITIAL_MATRIX,&S_all);CHKERRQ(ierr);
1046       reuse_solvers = PETSC_FALSE; /* TODO: why we can't reuse the solvers here? */
1047       factor_workaround = PETSC_FALSE;
1048       solver_S = PETSC_FALSE;
1049     }
1050 
1051     if (reuse_solvers) {
1052       Mat                A_II,Afake;
1053       Vec                vec1_B;
1054       PCBDDCReuseSolvers msolv_ctx;
1055       PetscInt           n_R;
1056 
1057       if (sub_schurs->reuse_solver) {
1058         ierr = PCBDDCReuseSolversReset(sub_schurs->reuse_solver);CHKERRQ(ierr);
1059       } else {
1060         ierr = PetscNew(&sub_schurs->reuse_solver);CHKERRQ(ierr);
1061       }
1062       msolv_ctx = sub_schurs->reuse_solver;
1063       ierr = MatSchurComplementGetSubMatrices(sub_schurs->S,&A_II,NULL,NULL,NULL,NULL);CHKERRQ(ierr);
1064       ierr = PetscObjectReference((PetscObject)F);CHKERRQ(ierr);
1065       msolv_ctx->F = F;
1066       ierr = MatCreateVecs(F,&msolv_ctx->sol,NULL);CHKERRQ(ierr);
1067       /* currently PETSc has no support for MatSolve(F,x,x), so cheat and let rhs and sol share the same memory */
1068       {
1069         PetscScalar *array;
1070         PetscInt    n;
1071 
1072         ierr = VecGetLocalSize(msolv_ctx->sol,&n);CHKERRQ(ierr);
1073         ierr = VecGetArray(msolv_ctx->sol,&array);CHKERRQ(ierr);
1074         ierr = VecCreateSeqWithArray(PetscObjectComm((PetscObject)msolv_ctx->sol),1,n,array,&msolv_ctx->rhs);CHKERRQ(ierr);
1075         ierr = VecRestoreArray(msolv_ctx->sol,&array);CHKERRQ(ierr);
1076       }
1077       msolv_ctx->has_vertices = schur_has_vertices;
1078 
1079       /* interior solver */
1080       ierr = PCCreate(PetscObjectComm((PetscObject)A_II),&msolv_ctx->interior_solver);CHKERRQ(ierr);
1081       ierr = PCSetOperators(msolv_ctx->interior_solver,A_II,A_II);CHKERRQ(ierr);
1082       ierr = PCSetType(msolv_ctx->interior_solver,PCSHELL);CHKERRQ(ierr);
1083       ierr = PCShellSetContext(msolv_ctx->interior_solver,msolv_ctx);CHKERRQ(ierr);
1084       ierr = PCShellSetApply(msolv_ctx->interior_solver,PCBDDCReuseSolvers_Interior);CHKERRQ(ierr);
1085       ierr = PCShellSetApplyTranspose(msolv_ctx->interior_solver,PCBDDCReuseSolvers_InteriorTranspose);CHKERRQ(ierr);
1086 
1087       /* correction solver */
1088       ierr = PCCreate(PetscObjectComm((PetscObject)A_II),&msolv_ctx->correction_solver);CHKERRQ(ierr);
1089       ierr = PCSetType(msolv_ctx->correction_solver,PCSHELL);CHKERRQ(ierr);
1090       ierr = PCShellSetContext(msolv_ctx->correction_solver,msolv_ctx);CHKERRQ(ierr);
1091       ierr = PCShellSetApply(msolv_ctx->correction_solver,PCBDDCReuseSolvers_Correction);CHKERRQ(ierr);
1092       ierr = PCShellSetApplyTranspose(msolv_ctx->correction_solver,PCBDDCReuseSolvers_CorrectionTranspose);CHKERRQ(ierr);
1093 
1094       /* scatter and vecs for Schur complement solver */
1095       ierr = MatCreateVecs(S_all,&msolv_ctx->sol_B,&msolv_ctx->rhs_B);CHKERRQ(ierr);
1096       ierr = MatCreateVecs(sub_schurs->S,&vec1_B,NULL);CHKERRQ(ierr);
1097       if (!schur_has_vertices) {
1098         ierr = ISGlobalToLocalMappingApplyIS(sub_schurs->BtoNmap,IS_GTOLM_DROP,is_A_all,&msolv_ctx->is_B);CHKERRQ(ierr);
1099         ierr = VecScatterCreate(vec1_B,msolv_ctx->is_B,msolv_ctx->sol_B,NULL,&msolv_ctx->correction_scatter_B);CHKERRQ(ierr);
1100         ierr = PetscObjectReference((PetscObject)is_A_all);CHKERRQ(ierr);
1101         msolv_ctx->is_R = is_A_all;
1102       } else {
1103         IS              is_B_all;
1104         const PetscInt* idxs;
1105         PetscInt        dual,n_v,n;
1106 
1107         ierr = ISGetLocalSize(sub_schurs->is_vertices,&n_v);CHKERRQ(ierr);
1108         dual = size_schur - n_v;
1109         ierr = ISGetLocalSize(is_A_all,&n);CHKERRQ(ierr);
1110         ierr = ISGetIndices(is_A_all,&idxs);CHKERRQ(ierr);
1111         ierr = ISCreateGeneral(PetscObjectComm((PetscObject)is_A_all),dual,idxs+n_I,PETSC_COPY_VALUES,&is_B_all);CHKERRQ(ierr);
1112         ierr = ISGlobalToLocalMappingApplyIS(sub_schurs->BtoNmap,IS_GTOLM_DROP,is_B_all,&msolv_ctx->is_B);CHKERRQ(ierr);
1113         ierr = ISDestroy(&is_B_all);CHKERRQ(ierr);
1114         ierr = ISCreateStride(PetscObjectComm((PetscObject)is_A_all),dual,0,1,&is_B_all);CHKERRQ(ierr);
1115         ierr = VecScatterCreate(vec1_B,msolv_ctx->is_B,msolv_ctx->sol_B,is_B_all,&msolv_ctx->correction_scatter_B);CHKERRQ(ierr);
1116         ierr = ISDestroy(&is_B_all);CHKERRQ(ierr);
1117         ierr = ISCreateGeneral(PetscObjectComm((PetscObject)is_A_all),n-n_v,idxs,PETSC_COPY_VALUES,&msolv_ctx->is_R);CHKERRQ(ierr);
1118         ierr = ISRestoreIndices(is_A_all,&idxs);CHKERRQ(ierr);
1119       }
1120       ierr = ISGetLocalSize(msolv_ctx->is_R,&n_R);CHKERRQ(ierr);
1121       ierr = MatCreateSeqAIJ(PETSC_COMM_SELF,n_R,n_R,0,NULL,&Afake);CHKERRQ(ierr);
1122       ierr = MatAssemblyBegin(Afake,MAT_FINAL_ASSEMBLY);CHKERRQ(ierr);
1123       ierr = MatAssemblyEnd(Afake,MAT_FINAL_ASSEMBLY);CHKERRQ(ierr);
1124       ierr = PCSetOperators(msolv_ctx->correction_solver,Afake,Afake);CHKERRQ(ierr);
1125       ierr = MatDestroy(&Afake);CHKERRQ(ierr);
1126       ierr = VecDestroy(&vec1_B);CHKERRQ(ierr);
1127 
1128       /* communicate benign info to solver context */
1129       if (benign_n) {
1130         PetscScalar *array;
1131 
1132         msolv_ctx->benign_n = benign_n;
1133         msolv_ctx->benign_zerodiag_subs = is_p_r;
1134         ierr = PetscMalloc1(benign_n,&msolv_ctx->benign_save_vals);CHKERRQ(ierr);
1135         msolv_ctx->benign_csAIB = cs_AIB_mat;
1136         ierr = MatCreateVecs(cs_AIB_mat,&msolv_ctx->benign_corr_work,NULL);CHKERRQ(ierr);
1137         ierr = VecGetArray(msolv_ctx->benign_corr_work,&array);CHKERRQ(ierr);
1138         ierr = VecCreateSeqWithArray(PETSC_COMM_SELF,1,size_schur,array,&msolv_ctx->benign_dummy_schur_vec);CHKERRQ(ierr);
1139         ierr = VecRestoreArray(msolv_ctx->benign_corr_work,&array);CHKERRQ(ierr);
1140         msolv_ctx->benign_AIIm1ones = benign_AIIm1_ones_mat;
1141       }
1142     } else {
1143       if (sub_schurs->reuse_solver) {
1144         ierr = PCBDDCReuseSolversReset(sub_schurs->reuse_solver);CHKERRQ(ierr);
1145       }
1146       ierr = PetscFree(sub_schurs->reuse_solver);CHKERRQ(ierr);
1147     }
1148     ierr = MatDestroy(&A);CHKERRQ(ierr);
1149     ierr = ISDestroy(&is_A_all);CHKERRQ(ierr);
1150 
1151     /* Work arrays */
1152     ierr = PetscMalloc2(max_subset_size,&dummy_idx,max_subset_size*max_subset_size,&work);CHKERRQ(ierr);
1153 
1154     /* matrices for deluxe scaling and adaptive selection */
1155     if (compute_Stilda) {
1156       if (!sub_schurs->sum_S_Ej_tilda_all) {
1157         ierr = MatDuplicate(sub_schurs->S_Ej_all,MAT_SHARE_NONZERO_PATTERN,&sub_schurs->sum_S_Ej_tilda_all);CHKERRQ(ierr);
1158       }
1159       if (!sub_schurs->sum_S_Ej_inv_all && deluxe) {
1160         ierr = MatDuplicate(sub_schurs->S_Ej_all,MAT_SHARE_NONZERO_PATTERN,&sub_schurs->sum_S_Ej_inv_all);CHKERRQ(ierr);
1161       }
1162     }
1163 
1164     /* S_Ej_all */
1165     cum = cum2 = 0;
1166     ierr = MatDenseGetArray(S_all,&S_data);CHKERRQ(ierr);
1167     for (i=0;i<sub_schurs->n_subs;i++) {
1168       PetscInt j;
1169 
1170       /* get S_E */
1171       ierr = ISGetLocalSize(sub_schurs->is_subs[i],&subset_size);CHKERRQ(ierr);
1172       if (S_lower_triangular) { /* I need to expand the upper triangular data (column oriented) */
1173         PetscInt k;
1174         for (k=0;k<subset_size;k++) {
1175           for (j=k;j<subset_size;j++) {
1176             work[k*subset_size+j] = S_data[cum2+k*size_schur+j];
1177             work[j*subset_size+k] = PetscConj(S_data[cum2+k*size_schur+j]);
1178           }
1179         }
1180       } else { /* just copy to workspace */
1181         PetscInt k;
1182         for (k=0;k<subset_size;k++) {
1183           for (j=0;j<subset_size;j++) {
1184             work[k*subset_size+j] = S_data[cum2+k*size_schur+j];
1185           }
1186         }
1187       }
1188       /* insert S_E values */
1189       for (j=0;j<subset_size;j++) dummy_idx[j] = cum+j;
1190       if (sub_schurs->change) {
1191         Mat change_sub,SEj,T;
1192 
1193         /* change basis */
1194         ierr = KSPGetOperators(sub_schurs->change[i],&change_sub,NULL);CHKERRQ(ierr);
1195         ierr = MatCreateSeqDense(PETSC_COMM_SELF,subset_size,subset_size,work,&SEj);CHKERRQ(ierr);
1196         if (!sub_schurs->change_with_qr) { /* currently there's no support for PtAP with P SeqAIJ */
1197           Mat T2;
1198           ierr = MatTransposeMatMult(change_sub,SEj,MAT_INITIAL_MATRIX,1.0,&T2);CHKERRQ(ierr);
1199           ierr = MatMatMult(T2,change_sub,MAT_INITIAL_MATRIX,1.0,&T);CHKERRQ(ierr);
1200           ierr = MatConvert(T,MATSEQDENSE,MAT_INPLACE_MATRIX,&T);CHKERRQ(ierr);
1201           ierr = MatDestroy(&T2);CHKERRQ(ierr);
1202         } else {
1203           ierr = MatPtAP(SEj,change_sub,MAT_INITIAL_MATRIX,1.0,&T);CHKERRQ(ierr);
1204         }
1205         ierr = MatCopy(T,SEj,SAME_NONZERO_PATTERN);CHKERRQ(ierr);
1206         ierr = MatDestroy(&T);CHKERRQ(ierr);
1207         ierr = MatZeroRowsColumnsIS(SEj,sub_schurs->change_primal_sub[i],1.0,NULL,NULL);CHKERRQ(ierr);
1208         ierr = MatDestroy(&SEj);CHKERRQ(ierr);
1209       }
1210       if (deluxe) {
1211         ierr = MatSetValues(sub_schurs->S_Ej_all,subset_size,dummy_idx,subset_size,dummy_idx,work,INSERT_VALUES);CHKERRQ(ierr);
1212         /* if adaptivity is requested, invert S_E blocks */
1213         if (compute_Stilda) {
1214           ierr = PetscBLASIntCast(subset_size,&B_N);CHKERRQ(ierr);
1215           ierr = PetscFPTrapPush(PETSC_FP_TRAP_OFF);CHKERRQ(ierr);
1216           if (!use_getr) { /* TODO add sytrf/i for symmetric non hermitian */
1217             PetscInt k;
1218             PetscStackCallBLAS("LAPACKpotrf",LAPACKpotrf_("L",&B_N,work,&B_N,&B_ierr));
1219             if (B_ierr) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in POTRF Lapack routine %d",(int)B_ierr);
1220             PetscStackCallBLAS("LAPACKpotri",LAPACKpotri_("L",&B_N,work,&B_N,&B_ierr));
1221             if (B_ierr) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in POTRI Lapack routine %d",(int)B_ierr);
1222             for (k=0;k<subset_size;k++) {
1223               for (j=k;j<subset_size;j++) {
1224                 work[j*subset_size+k] = work[k*subset_size+j];
1225               }
1226             }
1227           } else {
1228             PetscStackCallBLAS("LAPACKgetrf",LAPACKgetrf_(&B_N,&B_N,work,&B_N,pivots,&B_ierr));
1229             if (B_ierr) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in GETRF Lapack routine %d",(int)B_ierr);
1230             PetscStackCallBLAS("LAPACKgetri",LAPACKgetri_(&B_N,work,&B_N,pivots,Bwork,&B_lwork,&B_ierr));
1231             if (B_ierr) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in GETRI Lapack routine %d",(int)B_ierr);
1232           }
1233           ierr = PetscFPTrapPop();CHKERRQ(ierr);
1234           ierr = MatSetValues(sub_schurs->sum_S_Ej_inv_all,subset_size,dummy_idx,subset_size,dummy_idx,work,INSERT_VALUES);CHKERRQ(ierr);
1235         }
1236       } else if (compute_Stilda) { /* not using deluxe */
1237         Mat         SEj;
1238         Vec         D;
1239         PetscScalar *array;
1240 
1241         ierr = MatCreateSeqDense(PETSC_COMM_SELF,subset_size,subset_size,work,&SEj);CHKERRQ(ierr);
1242         ierr = VecGetArray(Dall,&array);CHKERRQ(ierr);
1243         ierr = VecCreateSeqWithArray(PETSC_COMM_SELF,1,subset_size,array+cum,&D);CHKERRQ(ierr);
1244         ierr = VecRestoreArray(Dall,&array);CHKERRQ(ierr);
1245         ierr = VecShift(D,-1.);CHKERRQ(ierr);
1246         ierr = MatDiagonalScale(SEj,D,D);CHKERRQ(ierr);
1247         ierr = MatDestroy(&SEj);CHKERRQ(ierr);
1248         ierr = VecDestroy(&D);CHKERRQ(ierr);
1249         ierr = MatSetValues(sub_schurs->S_Ej_all,subset_size,dummy_idx,subset_size,dummy_idx,work,INSERT_VALUES);CHKERRQ(ierr);
1250       }
1251       cum += subset_size;
1252       cum2 += subset_size*(size_schur + 1);
1253     }
1254     ierr = MatDenseRestoreArray(S_all,&S_data);CHKERRQ(ierr);
1255 
1256     if (solver_S) {
1257       ierr = MatFactorRestoreSchurComplement(F,&S_all,MAT_FACTOR_SCHUR_UNFACTORED);CHKERRQ(ierr);
1258     }
1259 
1260     schur_factor = NULL;
1261     if (compute_Stilda && size_active_schur) {
1262 
1263       if (sub_schurs->n_subs == 1 && size_schur == size_active_schur && deluxe) { /* we already computed the inverse */
1264         PetscInt j;
1265         for (j=0;j<size_schur;j++) dummy_idx[j] = j;
1266         ierr = MatSetValues(sub_schurs->sum_S_Ej_tilda_all,size_schur,dummy_idx,size_schur,dummy_idx,work,INSERT_VALUES);CHKERRQ(ierr);
1267       } else {
1268         Mat S_all_inv=NULL;
1269         if (solver_S) {
1270           /* for adaptive selection we need S^-1; for solver reusage we need S_\Delta\Delta^-1.
1271              The latter is not the principal subminor for S^-1. However, the factors can be reused since S_\Delta\Delta is the leading principal submatrix of S */
1272           if (factor_workaround) {/* invert without calling MatFactorInvertSchurComplement, since we are hacking */
1273             PetscScalar *data;
1274             PetscInt     nd = 0;
1275 
1276             if (!sub_schurs->is_posdef) {
1277               SETERRQ(PETSC_COMM_SELF,PETSC_ERR_SUP,"Factor update not yet implemented for non SPD matrices");
1278             }
1279             ierr = MatFactorGetSchurComplement(F,&S_all_inv,NULL);CHKERRQ(ierr);
1280             ierr = MatDenseGetArray(S_all_inv,&data);CHKERRQ(ierr);
1281             if (sub_schurs->is_dir) { /* dirichlet dofs could have different scalings */
1282               ierr = ISGetLocalSize(sub_schurs->is_dir,&nd);CHKERRQ(ierr);
1283             }
1284 
1285             /* factor and invert activedofs and vertices (dirichlet dofs does not contribute) */
1286             if (schur_has_vertices) {
1287               Mat          M;
1288               PetscScalar *tdata;
1289               PetscInt     nv = 0, news;
1290 
1291               ierr = ISGetLocalSize(sub_schurs->is_vertices,&nv);CHKERRQ(ierr);
1292               news = size_active_schur + nv;
1293               ierr = PetscCalloc1(news*news,&tdata);CHKERRQ(ierr);
1294               for (i=0;i<size_active_schur;i++) {
1295                 ierr = PetscMemcpy(tdata+i*(news+1),data+i*(size_schur+1),(size_active_schur-i)*sizeof(PetscScalar));CHKERRQ(ierr);
1296                 ierr = PetscMemcpy(tdata+i*(news+1)+size_active_schur-i,data+i*size_schur+size_active_schur+nd,nv*sizeof(PetscScalar));CHKERRQ(ierr);
1297               }
1298               for (i=0;i<nv;i++) {
1299                 PetscInt k = i+size_active_schur;
1300                 ierr = PetscMemcpy(tdata+k*(news+1),data+(k+nd)*(size_schur+1),(nv-i)*sizeof(PetscScalar));CHKERRQ(ierr);
1301               }
1302 
1303               ierr = MatCreateSeqDense(PETSC_COMM_SELF,news,news,tdata,&M);CHKERRQ(ierr);
1304               ierr = MatSetOption(M,MAT_SPD,PETSC_TRUE);CHKERRQ(ierr);
1305               ierr = MatCholeskyFactor(M,NULL,NULL);CHKERRQ(ierr);
1306               /* save the factors */
1307               cum = 0;
1308               ierr = PetscMalloc1((size_active_schur*(size_active_schur +1))/2+nd,&schur_factor);CHKERRQ(ierr);
1309               for (i=0;i<size_active_schur;i++) {
1310                 ierr = PetscMemcpy(schur_factor+cum,tdata+i*(news+1),(size_active_schur-i)*sizeof(PetscScalar));CHKERRQ(ierr);
1311                 cum += size_active_schur - i;
1312               }
1313               for (i=0;i<nd;i++) schur_factor[cum+i] = PetscSqrtReal(PetscRealPart(data[(i+size_active_schur)*(size_schur+1)]));
1314               ierr = MatSeqDenseInvertFactors_Private(M);CHKERRQ(ierr);
1315               /* move back just the active dofs to the Schur complement */
1316               for (i=0;i<size_active_schur;i++) {
1317                 ierr = PetscMemcpy(data+i*size_schur,tdata+i*news,size_active_schur*sizeof(PetscScalar));CHKERRQ(ierr);
1318               }
1319               ierr = PetscFree(tdata);CHKERRQ(ierr);
1320               ierr = MatDestroy(&M);CHKERRQ(ierr);
1321             } else { /* we can factorize and invert just the activedofs */
1322               Mat M;
1323 
1324               ierr = MatCreateSeqDense(PETSC_COMM_SELF,size_active_schur,size_active_schur,data,&M);CHKERRQ(ierr);
1325               ierr = MatSeqDenseSetLDA(M,size_schur);CHKERRQ(ierr);
1326               ierr = MatSetOption(M,MAT_SPD,PETSC_TRUE);CHKERRQ(ierr);
1327               ierr = MatCholeskyFactor(M,NULL,NULL);CHKERRQ(ierr);
1328               ierr = MatSeqDenseInvertFactors_Private(M);CHKERRQ(ierr);
1329               ierr = MatDestroy(&M);CHKERRQ(ierr);
1330               for (i=0;i<nd;i++) data[(i+size_active_schur)*(size_schur+1)] = 1.0/data[(i+size_active_schur)*(size_schur+1)];
1331             }
1332             ierr = MatDenseRestoreArray(S_all_inv,&data);CHKERRQ(ierr);
1333           } else { /* use MatFactor calls to invert S */
1334             ierr = MatFactorInvertSchurComplement(F);CHKERRQ(ierr);
1335             ierr = MatFactorGetSchurComplement(F,&S_all_inv,NULL);CHKERRQ(ierr);
1336           }
1337         } else { /* we need to invert explicitly since we are not using MatFactor for S */
1338           ierr = PetscObjectReference((PetscObject)S_all);CHKERRQ(ierr);
1339           S_all_inv = S_all;
1340           ierr = MatDenseGetArray(S_all_inv,&S_data);CHKERRQ(ierr);
1341           ierr = PetscBLASIntCast(size_schur,&B_N);CHKERRQ(ierr);
1342           ierr = PetscFPTrapPush(PETSC_FP_TRAP_OFF);CHKERRQ(ierr);
1343           if (!use_getr) { /* TODO add sytrf/i for symmetric non hermitian */
1344             PetscStackCallBLAS("LAPACKpotrf",LAPACKpotrf_("L",&B_N,S_data,&B_N,&B_ierr));
1345             if (B_ierr) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in POTRF Lapack routine %d",(int)B_ierr);
1346             PetscStackCallBLAS("LAPACKpotri",LAPACKpotri_("L",&B_N,S_data,&B_N,&B_ierr));
1347             if (B_ierr) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in POTRI Lapack routine %d",(int)B_ierr);
1348           } else {
1349             PetscStackCallBLAS("LAPACKgetrf",LAPACKgetrf_(&B_N,&B_N,S_data,&B_N,pivots,&B_ierr));
1350             if (B_ierr) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in GETRF Lapack routine %d",(int)B_ierr);
1351             PetscStackCallBLAS("LAPACKgetri",LAPACKgetri_(&B_N,S_data,&B_N,pivots,Bwork,&B_lwork,&B_ierr));
1352             if (B_ierr) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in GETRI Lapack routine %d",(int)B_ierr);
1353           }
1354           ierr = PetscFPTrapPop();CHKERRQ(ierr);
1355           ierr = MatDenseRestoreArray(S_all_inv,&S_data);CHKERRQ(ierr);
1356         }
1357         /* S_Ej_tilda_all */
1358         cum = cum2 = 0;
1359         ierr = MatDenseGetArray(S_all_inv,&S_data);CHKERRQ(ierr);
1360         for (i=0;i<sub_schurs->n_subs;i++) {
1361           PetscInt j;
1362 
1363           ierr = ISGetLocalSize(sub_schurs->is_subs[i],&subset_size);CHKERRQ(ierr);
1364           /* get (St^-1)_E */
1365           /* Unless we are changing the variables, I don't need to expand to upper triangular since St^-1
1366              will be properly accessed later during adaptive selection */
1367           if (S_lower_triangular) {
1368             PetscInt k;
1369             if (sub_schurs->change) {
1370               for (k=0;k<subset_size;k++) {
1371                 for (j=k;j<subset_size;j++) {
1372                   work[k*subset_size+j] = S_data[cum2+k*size_schur+j];
1373                   work[j*subset_size+k] = work[k*subset_size+j];
1374                 }
1375               }
1376             } else {
1377               for (k=0;k<subset_size;k++) {
1378                 for (j=k;j<subset_size;j++) {
1379                   work[k*subset_size+j] = S_data[cum2+k*size_schur+j];
1380                 }
1381               }
1382             }
1383           } else {
1384             PetscInt k;
1385             for (k=0;k<subset_size;k++) {
1386               for (j=0;j<subset_size;j++) {
1387                 work[k*subset_size+j] = S_data[cum2+k*size_schur+j];
1388               }
1389             }
1390           }
1391           if (sub_schurs->change) {
1392             Mat change_sub,SEj,T;
1393 
1394             /* change basis */
1395             ierr = KSPGetOperators(sub_schurs->change[i],&change_sub,NULL);CHKERRQ(ierr);
1396             ierr = MatCreateSeqDense(PETSC_COMM_SELF,subset_size,subset_size,work,&SEj);CHKERRQ(ierr);
1397             if (!sub_schurs->change_with_qr) { /* currently there's no support for PtAP with P SeqAIJ */
1398               Mat T2;
1399               ierr = MatTransposeMatMult(change_sub,SEj,MAT_INITIAL_MATRIX,1.0,&T2);CHKERRQ(ierr);
1400               ierr = MatMatMult(T2,change_sub,MAT_INITIAL_MATRIX,1.0,&T);CHKERRQ(ierr);
1401               ierr = MatDestroy(&T2);CHKERRQ(ierr);
1402               ierr = MatConvert(T,MATSEQDENSE,MAT_INPLACE_MATRIX,&T);CHKERRQ(ierr);
1403             } else {
1404               ierr = MatPtAP(SEj,change_sub,MAT_INITIAL_MATRIX,1.0,&T);CHKERRQ(ierr);
1405             }
1406             ierr = MatCopy(T,SEj,SAME_NONZERO_PATTERN);CHKERRQ(ierr);
1407             ierr = MatDestroy(&T);CHKERRQ(ierr);
1408             /* set diagonal entry to a very large value to pick the basis we are eliminating as the first eigenvectors with adaptive selection */
1409             ierr = MatZeroRowsColumnsIS(SEj,sub_schurs->change_primal_sub[i],1./PETSC_SMALL,NULL,NULL);CHKERRQ(ierr);
1410             ierr = MatDestroy(&SEj);CHKERRQ(ierr);
1411           }
1412           for (j=0;j<subset_size;j++) dummy_idx[j] = cum+j;
1413           ierr = MatSetValues(sub_schurs->sum_S_Ej_tilda_all,subset_size,dummy_idx,subset_size,dummy_idx,work,INSERT_VALUES);CHKERRQ(ierr);
1414           cum += subset_size;
1415           cum2 += subset_size*(size_schur + 1);
1416         }
1417         ierr = MatDenseRestoreArray(S_all_inv,&S_data);CHKERRQ(ierr);
1418         if (solver_S) {
1419           if (schur_has_vertices) {
1420             ierr = MatFactorRestoreSchurComplement(F,&S_all_inv,MAT_FACTOR_SCHUR_FACTORED);CHKERRQ(ierr);
1421           } else {
1422             ierr = MatFactorRestoreSchurComplement(F,&S_all_inv,MAT_FACTOR_SCHUR_INVERTED);CHKERRQ(ierr);
1423           }
1424         }
1425         ierr = MatDestroy(&S_all_inv);CHKERRQ(ierr);
1426       }
1427 
1428       /* move back factors if needed */
1429       if (schur_has_vertices) {
1430         Mat      S_tmp;
1431         PetscInt nd = 0;
1432 
1433         if (!solver_S) SETERRQ(PETSC_COMM_SELF,PETSC_ERR_PLIB,"This should not happen");
1434         ierr = MatFactorGetSchurComplement(F,&S_tmp,NULL);CHKERRQ(ierr);
1435         if (sub_schurs->is_posdef) {
1436           PetscScalar *data;
1437 
1438           ierr = MatDenseGetArray(S_tmp,&data);CHKERRQ(ierr);
1439           ierr = PetscMemzero(data,size_schur*size_schur*sizeof(PetscScalar));CHKERRQ(ierr);
1440 
1441           if (S_lower_triangular) {
1442             cum = 0;
1443             for (i=0;i<size_active_schur;i++) {
1444               ierr = PetscMemcpy(data+i*(size_schur+1),schur_factor+cum,(size_active_schur-i)*sizeof(PetscScalar));CHKERRQ(ierr);
1445               cum += size_active_schur-i;
1446 	    }
1447           } else {
1448             ierr = PetscMemcpy(data,schur_factor,size_schur*size_schur*sizeof(PetscScalar));CHKERRQ(ierr);
1449           }
1450           if (sub_schurs->is_dir) {
1451             ierr = ISGetLocalSize(sub_schurs->is_dir,&nd);CHKERRQ(ierr);
1452 	    for (i=0;i<nd;i++) {
1453 	      data[(i+size_active_schur)*(size_schur+1)] = schur_factor[cum+i];
1454 	    }
1455           }
1456           /* workaround: since I cannot modify the matrices used inside the solvers for the forward and backward substitutions,
1457              set the diagonal entry of the Schur factor to a very large value */
1458           for (i=size_active_schur+nd;i<size_schur;i++) {
1459             data[i*(size_schur+1)] = infty;
1460           }
1461           ierr = MatDenseRestoreArray(S_tmp,&data);CHKERRQ(ierr);
1462         } else SETERRQ(PETSC_COMM_SELF,PETSC_ERR_SUP,"Factor update not yet implemented for non SPD matrices");
1463         ierr = MatFactorRestoreSchurComplement(F,&S_tmp,MAT_FACTOR_SCHUR_FACTORED);CHKERRQ(ierr);
1464       }
1465     } else if (factor_workaround) { /* we need to eliminate any unneeded coupling */
1466       PetscScalar *data;
1467       PetscInt    nd = 0;
1468 
1469       if (sub_schurs->is_dir) { /* dirichlet dofs could have different scalings */
1470         ierr = ISGetLocalSize(sub_schurs->is_dir,&nd);CHKERRQ(ierr);
1471       }
1472       ierr = MatFactorGetSchurComplement(F,&S_all,NULL);CHKERRQ(ierr);
1473       ierr = MatDenseGetArray(S_all,&data);CHKERRQ(ierr);
1474       for (i=0;i<size_active_schur;i++) {
1475         ierr = PetscMemzero(data+i*size_schur+size_active_schur,(size_schur-size_active_schur)*sizeof(PetscScalar));CHKERRQ(ierr);
1476       }
1477       for (i=size_active_schur+nd;i<size_schur;i++) {
1478         ierr = PetscMemzero(data+i*size_schur+size_active_schur,(size_schur-size_active_schur)*sizeof(PetscScalar));CHKERRQ(ierr);
1479         data[i*(size_schur+1)] = infty;
1480       }
1481       ierr = MatDenseRestoreArray(S_all,&data);CHKERRQ(ierr);
1482       ierr = MatFactorRestoreSchurComplement(F,&S_all,MAT_FACTOR_SCHUR_UNFACTORED);CHKERRQ(ierr);
1483     }
1484     ierr = PetscFree2(dummy_idx,work);CHKERRQ(ierr);
1485     ierr = PetscFree(schur_factor);CHKERRQ(ierr);
1486     ierr = VecDestroy(&Dall);CHKERRQ(ierr);
1487   }
1488   ierr = PetscFree(nnz);CHKERRQ(ierr);
1489   ierr = MatDestroy(&F);CHKERRQ(ierr);
1490   ierr = ISDestroy(&is_I_layer);CHKERRQ(ierr);
1491   ierr = MatDestroy(&S_all);CHKERRQ(ierr);
1492   ierr = MatDestroy(&A_BB);CHKERRQ(ierr);
1493   ierr = MatDestroy(&A_IB);CHKERRQ(ierr);
1494   ierr = MatDestroy(&A_BI);CHKERRQ(ierr);
1495   ierr = MatAssemblyBegin(sub_schurs->S_Ej_all,MAT_FINAL_ASSEMBLY);CHKERRQ(ierr);
1496   ierr = MatAssemblyEnd(sub_schurs->S_Ej_all,MAT_FINAL_ASSEMBLY);CHKERRQ(ierr);
1497   if (compute_Stilda) {
1498     ierr = MatAssemblyBegin(sub_schurs->sum_S_Ej_tilda_all,MAT_FINAL_ASSEMBLY);CHKERRQ(ierr);
1499     ierr = MatAssemblyEnd(sub_schurs->sum_S_Ej_tilda_all,MAT_FINAL_ASSEMBLY);CHKERRQ(ierr);
1500     if (deluxe) {
1501       ierr = MatAssemblyBegin(sub_schurs->sum_S_Ej_inv_all,MAT_FINAL_ASSEMBLY);CHKERRQ(ierr);
1502       ierr = MatAssemblyEnd(sub_schurs->sum_S_Ej_inv_all,MAT_FINAL_ASSEMBLY);CHKERRQ(ierr);
1503     }
1504   }
1505 
1506   /* Global matrix of all assembled Schur on subsets */
1507   ierr = MatISSetLocalMat(work_mat,sub_schurs->S_Ej_all);CHKERRQ(ierr);
1508   ierr = MatISSetMPIXAIJPreallocation_Private(work_mat,global_schur_subsets,PETSC_TRUE);CHKERRQ(ierr);
1509   ierr = MatISGetMPIXAIJ(work_mat,MAT_REUSE_MATRIX,&global_schur_subsets);CHKERRQ(ierr);
1510 
1511   /* Get local part of (\sum_j S_Ej) */
1512   ierr = MatCreateSubMatrices(global_schur_subsets,1,&all_subsets_n,&all_subsets_n,MAT_INITIAL_MATRIX,&submats);CHKERRQ(ierr);
1513   if (!sub_schurs->sum_S_Ej_all) {
1514     ierr = MatDuplicate(submats[0],MAT_COPY_VALUES,&sub_schurs->sum_S_Ej_all);CHKERRQ(ierr);
1515   } else {
1516     ierr = MatCopy(submats[0],sub_schurs->sum_S_Ej_all,SAME_NONZERO_PATTERN);CHKERRQ(ierr);
1517   }
1518 
1519   /* Get local part of (\sum_j S^-1_Ej) (\sum_j St^-1_Ej) */
1520   if (compute_Stilda) {
1521     ierr = MatISSetLocalMat(work_mat,sub_schurs->sum_S_Ej_tilda_all);CHKERRQ(ierr);
1522     ierr = MatISGetMPIXAIJ(work_mat,MAT_REUSE_MATRIX,&global_schur_subsets);CHKERRQ(ierr);
1523     ierr = MatCreateSubMatrices(global_schur_subsets,1,&all_subsets_n,&all_subsets_n,MAT_REUSE_MATRIX,&submats);CHKERRQ(ierr);
1524     ierr = MatCopy(submats[0],sub_schurs->sum_S_Ej_tilda_all,SAME_NONZERO_PATTERN);CHKERRQ(ierr);
1525     if (deluxe) {
1526       ierr = MatISSetLocalMat(work_mat,sub_schurs->sum_S_Ej_inv_all);CHKERRQ(ierr);
1527       ierr = MatISGetMPIXAIJ(work_mat,MAT_REUSE_MATRIX,&global_schur_subsets);CHKERRQ(ierr);
1528       ierr = MatCreateSubMatrices(global_schur_subsets,1,&all_subsets_n,&all_subsets_n,MAT_REUSE_MATRIX,&submats);CHKERRQ(ierr);
1529       ierr = MatCopy(submats[0],sub_schurs->sum_S_Ej_inv_all,SAME_NONZERO_PATTERN);CHKERRQ(ierr);
1530     } else {
1531       PetscScalar *array;
1532       PetscInt    cum;
1533 
1534       ierr = MatSeqAIJGetArray(sub_schurs->sum_S_Ej_tilda_all,&array);CHKERRQ(ierr);
1535       cum = 0;
1536       for (i=0;i<sub_schurs->n_subs;i++) {
1537         ierr = ISGetLocalSize(sub_schurs->is_subs[i],&subset_size);CHKERRQ(ierr);
1538         ierr = PetscBLASIntCast(subset_size,&B_N);CHKERRQ(ierr);
1539         ierr = PetscFPTrapPush(PETSC_FP_TRAP_OFF);CHKERRQ(ierr);
1540         PetscStackCallBLAS("LAPACKpotrf",LAPACKpotrf_("L",&B_N,array+cum,&B_N,&B_ierr));
1541         if (B_ierr) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in POTRF Lapack routine %d",(int)B_ierr);
1542         PetscStackCallBLAS("LAPACKpotri",LAPACKpotri_("L",&B_N,array+cum,&B_N,&B_ierr));
1543         if (B_ierr) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in POTRI Lapack routine %d",(int)B_ierr);
1544         ierr = PetscFPTrapPop();CHKERRQ(ierr);
1545         cum += subset_size*subset_size;
1546       }
1547       ierr = MatSeqAIJRestoreArray(sub_schurs->sum_S_Ej_tilda_all,&array);CHKERRQ(ierr);
1548       ierr = PetscObjectReference((PetscObject)sub_schurs->sum_S_Ej_all);CHKERRQ(ierr);
1549       ierr = MatDestroy(&sub_schurs->sum_S_Ej_inv_all);CHKERRQ(ierr);
1550       sub_schurs->sum_S_Ej_inv_all = sub_schurs->sum_S_Ej_all;
1551     }
1552   }
1553   ierr = MatDestroySubMatrices(1,&submats);CHKERRQ(ierr);
1554 
1555   /* free workspace */
1556   ierr = PetscFree(submats);CHKERRQ(ierr);
1557   ierr = PetscFree2(Bwork,pivots);CHKERRQ(ierr);
1558   ierr = MatDestroy(&global_schur_subsets);CHKERRQ(ierr);
1559   ierr = MatDestroy(&work_mat);CHKERRQ(ierr);
1560   ierr = ISDestroy(&all_subsets_n);CHKERRQ(ierr);
1561   ierr = PetscCommDestroy(&comm_n);CHKERRQ(ierr);
1562   PetscFunctionReturn(0);
1563 }
1564 
1565 PetscErrorCode PCBDDCSubSchursInit(PCBDDCSubSchurs sub_schurs, IS is_I, IS is_B, PCBDDCGraph graph, ISLocalToGlobalMapping BtoNmap, PetscBool copycc)
1566 {
1567   IS              *faces,*edges,*all_cc,vertices;
1568   PetscInt        i,n_faces,n_edges,n_all_cc;
1569   PetscBool       is_sorted;
1570   PetscErrorCode  ierr;
1571 
1572   PetscFunctionBegin;
1573   ierr = ISSorted(is_I,&is_sorted);CHKERRQ(ierr);
1574   if (!is_sorted) SETERRQ(PetscObjectComm((PetscObject)is_I),PETSC_ERR_PLIB,"IS for I dofs should be shorted");
1575   ierr = ISSorted(is_B,&is_sorted);CHKERRQ(ierr);
1576   if (!is_sorted) SETERRQ(PetscObjectComm((PetscObject)is_B),PETSC_ERR_PLIB,"IS for B dofs should be shorted");
1577 
1578   /* reset any previous data */
1579   ierr = PCBDDCSubSchursReset(sub_schurs);CHKERRQ(ierr);
1580 
1581   /* get index sets for faces and edges (already sorted by global ordering) */
1582   ierr = PCBDDCGraphGetCandidatesIS(graph,&n_faces,&faces,&n_edges,&edges,&vertices);CHKERRQ(ierr);
1583   n_all_cc = n_faces+n_edges;
1584   ierr = PetscBTCreate(n_all_cc,&sub_schurs->is_edge);CHKERRQ(ierr);
1585   ierr = PetscMalloc1(n_all_cc,&all_cc);CHKERRQ(ierr);
1586   for (i=0;i<n_faces;i++) {
1587     if (copycc) {
1588       ierr = ISDuplicate(faces[i],&all_cc[i]);CHKERRQ(ierr);
1589     } else {
1590       ierr = PetscObjectReference((PetscObject)faces[i]);CHKERRQ(ierr);
1591       all_cc[i] = faces[i];
1592     }
1593   }
1594   for (i=0;i<n_edges;i++) {
1595     if (copycc) {
1596       ierr = ISDuplicate(edges[i],&all_cc[n_faces+i]);CHKERRQ(ierr);
1597     } else {
1598       ierr = PetscObjectReference((PetscObject)edges[i]);CHKERRQ(ierr);
1599       all_cc[n_faces+i] = edges[i];
1600     }
1601     ierr = PetscBTSet(sub_schurs->is_edge,n_faces+i);CHKERRQ(ierr);
1602   }
1603   ierr = PetscObjectReference((PetscObject)vertices);CHKERRQ(ierr);
1604   sub_schurs->is_vertices = vertices;
1605   ierr = PCBDDCGraphRestoreCandidatesIS(graph,&n_faces,&faces,&n_edges,&edges,&vertices);CHKERRQ(ierr);
1606   sub_schurs->is_dir = NULL;
1607   ierr = PCBDDCGraphGetDirichletDofsB(graph,&sub_schurs->is_dir);CHKERRQ(ierr);
1608 
1609   /* Determine if MatFactor can be used */
1610   sub_schurs->schur_explicit = PETSC_FALSE;
1611 #if defined(PETSC_HAVE_MUMPS)
1612   sub_schurs->schur_explicit = PETSC_TRUE;
1613 #endif
1614 #if defined(PETSC_HAVE_MKL_PARDISO)
1615   sub_schurs->schur_explicit = PETSC_TRUE;
1616 #endif
1617 
1618   ierr = PetscObjectReference((PetscObject)is_I);CHKERRQ(ierr);
1619   sub_schurs->is_I = is_I;
1620   ierr = PetscObjectReference((PetscObject)is_B);CHKERRQ(ierr);
1621   sub_schurs->is_B = is_B;
1622   ierr = PetscObjectReference((PetscObject)graph->l2gmap);CHKERRQ(ierr);
1623   sub_schurs->l2gmap = graph->l2gmap;
1624   ierr = PetscObjectReference((PetscObject)BtoNmap);CHKERRQ(ierr);
1625   sub_schurs->BtoNmap = BtoNmap;
1626   sub_schurs->n_subs = n_all_cc;
1627   sub_schurs->is_subs = all_cc;
1628   if (!sub_schurs->schur_explicit) { /* sort by local ordering if we are not using MatFactor */
1629     for (i=0;i<sub_schurs->n_subs;i++) {
1630       ierr = ISSort(sub_schurs->is_subs[i]);CHKERRQ(ierr);
1631     }
1632   }
1633   sub_schurs->S_Ej_all = NULL;
1634   sub_schurs->sum_S_Ej_all = NULL;
1635   sub_schurs->sum_S_Ej_inv_all = NULL;
1636   sub_schurs->sum_S_Ej_tilda_all = NULL;
1637   sub_schurs->is_Ej_all = NULL;
1638   PetscFunctionReturn(0);
1639 }
1640 
1641 PetscErrorCode PCBDDCSubSchursCreate(PCBDDCSubSchurs *sub_schurs)
1642 {
1643   PCBDDCSubSchurs schurs_ctx;
1644   PetscErrorCode  ierr;
1645 
1646   PetscFunctionBegin;
1647   ierr = PetscNew(&schurs_ctx);CHKERRQ(ierr);
1648   schurs_ctx->n_subs = 0;
1649   *sub_schurs = schurs_ctx;
1650   PetscFunctionReturn(0);
1651 }
1652 
1653 PetscErrorCode PCBDDCSubSchursReset(PCBDDCSubSchurs sub_schurs)
1654 {
1655   PetscInt       i;
1656   PetscErrorCode ierr;
1657 
1658   PetscFunctionBegin;
1659   if (!sub_schurs) PetscFunctionReturn(0);
1660   ierr = MatDestroy(&sub_schurs->A);CHKERRQ(ierr);
1661   ierr = MatDestroy(&sub_schurs->S);CHKERRQ(ierr);
1662   ierr = ISDestroy(&sub_schurs->is_I);CHKERRQ(ierr);
1663   ierr = ISDestroy(&sub_schurs->is_B);CHKERRQ(ierr);
1664   ierr = ISLocalToGlobalMappingDestroy(&sub_schurs->l2gmap);CHKERRQ(ierr);
1665   ierr = ISLocalToGlobalMappingDestroy(&sub_schurs->BtoNmap);CHKERRQ(ierr);
1666   ierr = MatDestroy(&sub_schurs->S_Ej_all);CHKERRQ(ierr);
1667   ierr = MatDestroy(&sub_schurs->sum_S_Ej_all);CHKERRQ(ierr);
1668   ierr = MatDestroy(&sub_schurs->sum_S_Ej_inv_all);CHKERRQ(ierr);
1669   ierr = MatDestroy(&sub_schurs->sum_S_Ej_tilda_all);CHKERRQ(ierr);
1670   ierr = ISDestroy(&sub_schurs->is_Ej_all);CHKERRQ(ierr);
1671   ierr = ISDestroy(&sub_schurs->is_vertices);CHKERRQ(ierr);
1672   ierr = ISDestroy(&sub_schurs->is_dir);CHKERRQ(ierr);
1673   ierr = PetscBTDestroy(&sub_schurs->is_edge);CHKERRQ(ierr);
1674   for (i=0;i<sub_schurs->n_subs;i++) {
1675     ierr = ISDestroy(&sub_schurs->is_subs[i]);CHKERRQ(ierr);
1676   }
1677   if (sub_schurs->n_subs) {
1678     ierr = PetscFree(sub_schurs->is_subs);CHKERRQ(ierr);
1679   }
1680   if (sub_schurs->reuse_solver) {
1681     ierr = PCBDDCReuseSolversReset(sub_schurs->reuse_solver);CHKERRQ(ierr);
1682   }
1683   ierr = PetscFree(sub_schurs->reuse_solver);CHKERRQ(ierr);
1684   if (sub_schurs->change) {
1685     for (i=0;i<sub_schurs->n_subs;i++) {
1686       ierr = KSPDestroy(&sub_schurs->change[i]);CHKERRQ(ierr);
1687       ierr = ISDestroy(&sub_schurs->change_primal_sub[i]);CHKERRQ(ierr);
1688     }
1689   }
1690   ierr = PetscFree(sub_schurs->change);CHKERRQ(ierr);
1691   ierr = PetscFree(sub_schurs->change_primal_sub);CHKERRQ(ierr);
1692   sub_schurs->n_subs = 0;
1693   PetscFunctionReturn(0);
1694 }
1695 
1696 PetscErrorCode PCBDDCSubSchursDestroy(PCBDDCSubSchurs* sub_schurs)
1697 {
1698   PetscErrorCode ierr;
1699 
1700   PetscFunctionBegin;
1701   ierr = PCBDDCSubSchursReset(*sub_schurs);CHKERRQ(ierr);
1702   ierr = PetscFree(*sub_schurs);CHKERRQ(ierr);
1703   PetscFunctionReturn(0);
1704 }
1705 
1706 PETSC_STATIC_INLINE PetscErrorCode PCBDDCAdjGetNextLayer_Private(PetscInt* queue_tip,PetscInt n_prev,PetscBT touched,PetscInt* xadj,PetscInt* adjncy,PetscInt* n_added)
1707 {
1708   PetscInt       i,j,n;
1709   PetscErrorCode ierr;
1710 
1711   PetscFunctionBegin;
1712   n = 0;
1713   for (i=-n_prev;i<0;i++) {
1714     PetscInt start_dof = queue_tip[i];
1715     for (j=xadj[start_dof];j<xadj[start_dof+1];j++) {
1716       PetscInt dof = adjncy[j];
1717       if (!PetscBTLookup(touched,dof)) {
1718         ierr = PetscBTSet(touched,dof);CHKERRQ(ierr);
1719         queue_tip[n] = dof;
1720         n++;
1721       }
1722     }
1723   }
1724   *n_added = n;
1725   PetscFunctionReturn(0);
1726 }
1727