xref: /petsc/src/ksp/pc/impls/bddc/bddcschurs.c (revision 7827d75ba736e00c19d105c058b1c2ddcca945c7)
134a97f8cSStefano Zampini #include <../src/ksp/pc/impls/bddc/bddc.h>
234a97f8cSStefano Zampini #include <../src/ksp/pc/impls/bddc/bddcprivate.h>
305709791SSatish Balay #include <../src/mat/impls/dense/seq/dense.h>
408122e43SStefano Zampini #include <petscblaslapack.h>
534a97f8cSStefano Zampini 
69fbee547SJacob Faibussowitsch static inline PetscErrorCode PCBDDCAdjGetNextLayer_Private(PetscInt*,PetscInt,PetscBT,PetscInt*,PetscInt*,PetscInt*);
75ec10c6aSStefano Zampini static PetscErrorCode PCBDDCComputeExplicitSchur(Mat,PetscBool,MatReuse,Mat*);
8df4d28bfSStefano Zampini static PetscErrorCode PCBDDCReuseSolvers_Interior(PC,Vec,Vec);
9df4d28bfSStefano Zampini static PetscErrorCode PCBDDCReuseSolvers_Correction(PC,Vec,Vec);
10d62866d3SStefano Zampini 
11ca92afb2SStefano Zampini /* if v2 is not present, correction is done in-place */
125cbda25cSStefano Zampini PetscErrorCode PCBDDCReuseSolversBenignAdapt(PCBDDCReuseSolvers ctx, Vec v, Vec v2, PetscBool sol, PetscBool full)
13ca92afb2SStefano Zampini {
14ca92afb2SStefano Zampini   PetscScalar    *array;
15ca92afb2SStefano Zampini   PetscScalar    *array2;
16ca92afb2SStefano Zampini 
17ca92afb2SStefano Zampini   PetscFunctionBegin;
18ca92afb2SStefano Zampini   if (!ctx->benign_n) PetscFunctionReturn(0);
195cbda25cSStefano Zampini   if (sol && full) {
205cbda25cSStefano Zampini     PetscInt n_I,size_schur;
215cbda25cSStefano Zampini 
225cbda25cSStefano Zampini     /* get sizes */
239566063dSJacob Faibussowitsch     PetscCall(MatGetSize(ctx->benign_csAIB,&size_schur,NULL));
249566063dSJacob Faibussowitsch     PetscCall(VecGetSize(v,&n_I));
255cbda25cSStefano Zampini     n_I = n_I - size_schur;
265cbda25cSStefano Zampini     /* get schur sol from array */
279566063dSJacob Faibussowitsch     PetscCall(VecGetArray(v,&array));
289566063dSJacob Faibussowitsch     PetscCall(VecPlaceArray(ctx->benign_dummy_schur_vec,array+n_I));
299566063dSJacob Faibussowitsch     PetscCall(VecRestoreArray(v,&array));
305cbda25cSStefano Zampini     /* apply interior sol correction */
319566063dSJacob Faibussowitsch     PetscCall(MatMultTranspose(ctx->benign_csAIB,ctx->benign_dummy_schur_vec,ctx->benign_corr_work));
329566063dSJacob Faibussowitsch     PetscCall(VecResetArray(ctx->benign_dummy_schur_vec));
339566063dSJacob Faibussowitsch     PetscCall(MatMultAdd(ctx->benign_AIIm1ones,ctx->benign_corr_work,v,v));
345cbda25cSStefano Zampini   }
35ca92afb2SStefano Zampini   if (v2) {
36ca92afb2SStefano Zampini     PetscInt nl;
37ca92afb2SStefano Zampini 
389566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(v,(const PetscScalar**)&array));
399566063dSJacob Faibussowitsch     PetscCall(VecGetLocalSize(v2,&nl));
409566063dSJacob Faibussowitsch     PetscCall(VecGetArray(v2,&array2));
419566063dSJacob Faibussowitsch     PetscCall(PetscArraycpy(array2,array,nl));
42ca92afb2SStefano Zampini   } else {
439566063dSJacob Faibussowitsch     PetscCall(VecGetArray(v,&array));
44ca92afb2SStefano Zampini     array2 = array;
45ca92afb2SStefano Zampini   }
46ca92afb2SStefano Zampini   if (!sol) { /* change rhs */
47ca92afb2SStefano Zampini     PetscInt n;
48ca92afb2SStefano Zampini     for (n=0;n<ctx->benign_n;n++) {
49ca92afb2SStefano Zampini       PetscScalar    sum = 0.;
50ca92afb2SStefano Zampini       const PetscInt *cols;
51ca92afb2SStefano Zampini       PetscInt       nz,i;
52ca92afb2SStefano Zampini 
539566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(ctx->benign_zerodiag_subs[n],&nz));
549566063dSJacob Faibussowitsch       PetscCall(ISGetIndices(ctx->benign_zerodiag_subs[n],&cols));
55ca92afb2SStefano Zampini       for (i=0;i<nz-1;i++) sum += array[cols[i]];
5622db5ddcSStefano Zampini #if defined(PETSC_USE_COMPLEX)
5722db5ddcSStefano Zampini       sum = -(PetscRealPart(sum)/nz + PETSC_i*(PetscImaginaryPart(sum)/nz));
5822db5ddcSStefano Zampini #else
59ca92afb2SStefano Zampini       sum = -sum/nz;
6022db5ddcSStefano Zampini #endif
61ca92afb2SStefano Zampini       for (i=0;i<nz-1;i++) array2[cols[i]] += sum;
62ca92afb2SStefano Zampini       ctx->benign_save_vals[n] = array2[cols[nz-1]];
63ca92afb2SStefano Zampini       array2[cols[nz-1]] = sum;
649566063dSJacob Faibussowitsch       PetscCall(ISRestoreIndices(ctx->benign_zerodiag_subs[n],&cols));
65ca92afb2SStefano Zampini     }
66ca92afb2SStefano Zampini   } else {
67ca92afb2SStefano Zampini     PetscInt n;
68ca92afb2SStefano Zampini     for (n=0;n<ctx->benign_n;n++) {
69ca92afb2SStefano Zampini       PetscScalar    sum = 0.;
70ca92afb2SStefano Zampini       const PetscInt *cols;
71ca92afb2SStefano Zampini       PetscInt       nz,i;
729566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(ctx->benign_zerodiag_subs[n],&nz));
739566063dSJacob Faibussowitsch       PetscCall(ISGetIndices(ctx->benign_zerodiag_subs[n],&cols));
74ca92afb2SStefano Zampini       for (i=0;i<nz-1;i++) sum += array[cols[i]];
7522db5ddcSStefano Zampini #if defined(PETSC_USE_COMPLEX)
7622db5ddcSStefano Zampini       sum = -(PetscRealPart(sum)/nz + PETSC_i*(PetscImaginaryPart(sum)/nz));
7722db5ddcSStefano Zampini #else
78ca92afb2SStefano Zampini       sum = -sum/nz;
7922db5ddcSStefano Zampini #endif
80ca92afb2SStefano Zampini       for (i=0;i<nz-1;i++) array2[cols[i]] += sum;
81ca92afb2SStefano Zampini       array2[cols[nz-1]] = ctx->benign_save_vals[n];
829566063dSJacob Faibussowitsch       PetscCall(ISRestoreIndices(ctx->benign_zerodiag_subs[n],&cols));
83ca92afb2SStefano Zampini     }
84ca92afb2SStefano Zampini   }
85ca92afb2SStefano Zampini   if (v2) {
869566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(v,(const PetscScalar**)&array));
879566063dSJacob Faibussowitsch     PetscCall(VecRestoreArray(v2,&array2));
88ca92afb2SStefano Zampini   } else {
899566063dSJacob Faibussowitsch     PetscCall(VecRestoreArray(v,&array));
90ca92afb2SStefano Zampini   }
915cbda25cSStefano Zampini   if (!sol && full) {
925cbda25cSStefano Zampini     Vec      usedv;
935cbda25cSStefano Zampini     PetscInt n_I,size_schur;
945cbda25cSStefano Zampini 
955cbda25cSStefano Zampini     /* get sizes */
969566063dSJacob Faibussowitsch     PetscCall(MatGetSize(ctx->benign_csAIB,&size_schur,NULL));
979566063dSJacob Faibussowitsch     PetscCall(VecGetSize(v,&n_I));
985cbda25cSStefano Zampini     n_I = n_I - size_schur;
995cbda25cSStefano Zampini     /* compute schur rhs correction */
1005cbda25cSStefano Zampini     if (v2) {
1015cbda25cSStefano Zampini       usedv = v2;
1025cbda25cSStefano Zampini     } else {
1035cbda25cSStefano Zampini       usedv = v;
1045cbda25cSStefano Zampini     }
1055cbda25cSStefano Zampini     /* apply schur rhs correction */
1069566063dSJacob Faibussowitsch     PetscCall(MatMultTranspose(ctx->benign_AIIm1ones,usedv,ctx->benign_corr_work));
1079566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(usedv,(const PetscScalar**)&array));
1089566063dSJacob Faibussowitsch     PetscCall(VecPlaceArray(ctx->benign_dummy_schur_vec,array+n_I));
1099566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(usedv,(const PetscScalar**)&array));
1109566063dSJacob Faibussowitsch     PetscCall(MatMultAdd(ctx->benign_csAIB,ctx->benign_corr_work,ctx->benign_dummy_schur_vec,ctx->benign_dummy_schur_vec));
1119566063dSJacob Faibussowitsch     PetscCall(VecResetArray(ctx->benign_dummy_schur_vec));
1125cbda25cSStefano Zampini   }
113ca92afb2SStefano Zampini   PetscFunctionReturn(0);
114ca92afb2SStefano Zampini }
115ca92afb2SStefano Zampini 
116df4d28bfSStefano Zampini static PetscErrorCode PCBDDCReuseSolvers_Solve_Private(PC pc, Vec rhs, Vec sol, PetscBool transpose, PetscBool full)
117d62866d3SStefano Zampini {
118df4d28bfSStefano Zampini   PCBDDCReuseSolvers ctx;
119683d3df6SStefano Zampini   PetscBool          copy = PETSC_FALSE;
120d62866d3SStefano Zampini 
121d62866d3SStefano Zampini   PetscFunctionBegin;
1229566063dSJacob Faibussowitsch   PetscCall(PCShellGetContext(pc,&ctx));
123683d3df6SStefano Zampini   if (full) {
124d62866d3SStefano Zampini #if defined(PETSC_HAVE_MUMPS)
1259566063dSJacob Faibussowitsch     PetscCall(MatMumpsSetIcntl(ctx->F,26,-1));
126d62866d3SStefano Zampini #endif
1275cbda25cSStefano Zampini #if defined(PETSC_HAVE_MKL_PARDISO)
1289566063dSJacob Faibussowitsch     PetscCall(MatMkl_PardisoSetCntl(ctx->F,70,0));
1295cbda25cSStefano Zampini #endif
130683d3df6SStefano Zampini     copy = ctx->has_vertices;
131d4933d67SStefano Zampini   } else { /* interior solver */
1326dba178dSStefano Zampini #if defined(PETSC_HAVE_MUMPS)
1339566063dSJacob Faibussowitsch     PetscCall(MatMumpsSetIcntl(ctx->F,26,0));
1346dba178dSStefano Zampini #endif
135d4933d67SStefano Zampini #if defined(PETSC_HAVE_MKL_PARDISO)
1369566063dSJacob Faibussowitsch     PetscCall(MatMkl_PardisoSetCntl(ctx->F,70,1));
137d4933d67SStefano Zampini #endif
138683d3df6SStefano Zampini     copy = PETSC_TRUE;
139683d3df6SStefano Zampini   }
140683d3df6SStefano Zampini   /* copy rhs into factored matrix workspace */
141683d3df6SStefano Zampini   if (copy) {
142ca92afb2SStefano Zampini     PetscInt    n;
143df4d28bfSStefano Zampini     PetscScalar *array,*array_solver;
144ca92afb2SStefano Zampini 
1459566063dSJacob Faibussowitsch     PetscCall(VecGetLocalSize(rhs,&n));
1469566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(rhs,(const PetscScalar**)&array));
1479566063dSJacob Faibussowitsch     PetscCall(VecGetArray(ctx->rhs,&array_solver));
1489566063dSJacob Faibussowitsch     PetscCall(PetscArraycpy(array_solver,array,n));
1499566063dSJacob Faibussowitsch     PetscCall(VecRestoreArray(ctx->rhs,&array_solver));
1509566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(rhs,(const PetscScalar**)&array));
151683d3df6SStefano Zampini 
1529566063dSJacob Faibussowitsch     PetscCall(PCBDDCReuseSolversBenignAdapt(ctx,ctx->rhs,NULL,PETSC_FALSE,full));
153683d3df6SStefano Zampini     if (transpose) {
1549566063dSJacob Faibussowitsch       PetscCall(MatSolveTranspose(ctx->F,ctx->rhs,ctx->sol));
155683d3df6SStefano Zampini     } else {
1569566063dSJacob Faibussowitsch       PetscCall(MatSolve(ctx->F,ctx->rhs,ctx->sol));
157683d3df6SStefano Zampini     }
1589566063dSJacob Faibussowitsch     PetscCall(PCBDDCReuseSolversBenignAdapt(ctx,ctx->sol,NULL,PETSC_TRUE,full));
159683d3df6SStefano Zampini 
160683d3df6SStefano Zampini     /* get back data to caller worskpace */
1619566063dSJacob Faibussowitsch     PetscCall(VecGetArrayRead(ctx->sol,(const PetscScalar**)&array_solver));
1629566063dSJacob Faibussowitsch     PetscCall(VecGetArray(sol,&array));
1639566063dSJacob Faibussowitsch     PetscCall(PetscArraycpy(array,array_solver,n));
1649566063dSJacob Faibussowitsch     PetscCall(VecRestoreArray(sol,&array));
1659566063dSJacob Faibussowitsch     PetscCall(VecRestoreArrayRead(ctx->sol,(const PetscScalar**)&array_solver));
166683d3df6SStefano Zampini   } else {
167ca92afb2SStefano Zampini     if (ctx->benign_n) {
1689566063dSJacob Faibussowitsch       PetscCall(PCBDDCReuseSolversBenignAdapt(ctx,rhs,ctx->rhs,PETSC_FALSE,full));
169ca92afb2SStefano Zampini       if (transpose) {
1709566063dSJacob Faibussowitsch         PetscCall(MatSolveTranspose(ctx->F,ctx->rhs,sol));
171ca92afb2SStefano Zampini       } else {
1729566063dSJacob Faibussowitsch         PetscCall(MatSolve(ctx->F,ctx->rhs,sol));
173ca92afb2SStefano Zampini       }
1749566063dSJacob Faibussowitsch       PetscCall(PCBDDCReuseSolversBenignAdapt(ctx,sol,NULL,PETSC_TRUE,full));
175ca92afb2SStefano Zampini     } else {
176e28d306cSStefano Zampini       if (transpose) {
1779566063dSJacob Faibussowitsch         PetscCall(MatSolveTranspose(ctx->F,rhs,sol));
178e28d306cSStefano Zampini       } else {
1799566063dSJacob Faibussowitsch         PetscCall(MatSolve(ctx->F,rhs,sol));
180e28d306cSStefano Zampini       }
181683d3df6SStefano Zampini     }
182ca92afb2SStefano Zampini   }
1835cbda25cSStefano Zampini   /* restore defaults */
1845cbda25cSStefano Zampini #if defined(PETSC_HAVE_MUMPS)
1859566063dSJacob Faibussowitsch   PetscCall(MatMumpsSetIcntl(ctx->F,26,-1));
1865cbda25cSStefano Zampini #endif
187d4933d67SStefano Zampini #if defined(PETSC_HAVE_MKL_PARDISO)
1889566063dSJacob Faibussowitsch   PetscCall(MatMkl_PardisoSetCntl(ctx->F,70,0));
189d4933d67SStefano Zampini #endif
190d62866d3SStefano Zampini   PetscFunctionReturn(0);
191d62866d3SStefano Zampini }
192d62866d3SStefano Zampini 
193df4d28bfSStefano Zampini static PetscErrorCode PCBDDCReuseSolvers_Correction(PC pc, Vec rhs, Vec sol)
194e28d306cSStefano Zampini {
195e28d306cSStefano Zampini   PetscFunctionBegin;
1969566063dSJacob Faibussowitsch   PetscCall(PCBDDCReuseSolvers_Solve_Private(pc,rhs,sol,PETSC_FALSE,PETSC_TRUE));
197e28d306cSStefano Zampini   PetscFunctionReturn(0);
198e28d306cSStefano Zampini }
199e28d306cSStefano Zampini 
200df4d28bfSStefano Zampini static PetscErrorCode PCBDDCReuseSolvers_CorrectionTranspose(PC pc, Vec rhs, Vec sol)
201e28d306cSStefano Zampini {
202e28d306cSStefano Zampini   PetscFunctionBegin;
2039566063dSJacob Faibussowitsch   PetscCall(PCBDDCReuseSolvers_Solve_Private(pc,rhs,sol,PETSC_TRUE,PETSC_TRUE));
204683d3df6SStefano Zampini   PetscFunctionReturn(0);
205683d3df6SStefano Zampini }
206683d3df6SStefano Zampini 
207df4d28bfSStefano Zampini static PetscErrorCode PCBDDCReuseSolvers_Interior(PC pc, Vec rhs, Vec sol)
208683d3df6SStefano Zampini {
209683d3df6SStefano Zampini   PetscFunctionBegin;
2109566063dSJacob Faibussowitsch   PetscCall(PCBDDCReuseSolvers_Solve_Private(pc,rhs,sol,PETSC_FALSE,PETSC_FALSE));
211683d3df6SStefano Zampini   PetscFunctionReturn(0);
212683d3df6SStefano Zampini }
213683d3df6SStefano Zampini 
214df4d28bfSStefano Zampini static PetscErrorCode PCBDDCReuseSolvers_InteriorTranspose(PC pc, Vec rhs, Vec sol)
215683d3df6SStefano Zampini {
216683d3df6SStefano Zampini   PetscFunctionBegin;
2179566063dSJacob Faibussowitsch   PetscCall(PCBDDCReuseSolvers_Solve_Private(pc,rhs,sol,PETSC_TRUE,PETSC_FALSE));
218e28d306cSStefano Zampini   PetscFunctionReturn(0);
219e28d306cSStefano Zampini }
220e28d306cSStefano Zampini 
22115579a77SStefano Zampini static PetscErrorCode PCBDDCReuseSolvers_View(PC pc, PetscViewer viewer)
22215579a77SStefano Zampini {
22315579a77SStefano Zampini   PCBDDCReuseSolvers ctx;
22415579a77SStefano Zampini   PetscBool          iascii;
22515579a77SStefano Zampini 
22615579a77SStefano Zampini   PetscFunctionBegin;
2279566063dSJacob Faibussowitsch   PetscCall(PCShellGetContext(pc,&ctx));
2289566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject)viewer,PETSCVIEWERASCII,&iascii));
22915579a77SStefano Zampini   if (iascii) {
2309566063dSJacob Faibussowitsch     PetscCall(PetscViewerPushFormat(viewer,PETSC_VIEWER_ASCII_INFO));
23115579a77SStefano Zampini   }
2329566063dSJacob Faibussowitsch   PetscCall(MatView(ctx->F,viewer));
23315579a77SStefano Zampini   if (iascii) {
2349566063dSJacob Faibussowitsch     PetscCall(PetscViewerPopFormat(viewer));
23515579a77SStefano Zampini   }
23615579a77SStefano Zampini   PetscFunctionReturn(0);
23715579a77SStefano Zampini }
23815579a77SStefano Zampini 
239df4d28bfSStefano Zampini static PetscErrorCode PCBDDCReuseSolversReset(PCBDDCReuseSolvers reuse)
240d62866d3SStefano Zampini {
241ca92afb2SStefano Zampini   PetscInt       i;
242d62866d3SStefano Zampini 
243d62866d3SStefano Zampini   PetscFunctionBegin;
2449566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&reuse->F));
2459566063dSJacob Faibussowitsch   PetscCall(VecDestroy(&reuse->sol));
2469566063dSJacob Faibussowitsch   PetscCall(VecDestroy(&reuse->rhs));
2479566063dSJacob Faibussowitsch   PetscCall(PCDestroy(&reuse->interior_solver));
2489566063dSJacob Faibussowitsch   PetscCall(PCDestroy(&reuse->correction_solver));
2499566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&reuse->is_R));
2509566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&reuse->is_B));
2519566063dSJacob Faibussowitsch   PetscCall(VecScatterDestroy(&reuse->correction_scatter_B));
2529566063dSJacob Faibussowitsch   PetscCall(VecDestroy(&reuse->sol_B));
2539566063dSJacob Faibussowitsch   PetscCall(VecDestroy(&reuse->rhs_B));
254ca92afb2SStefano Zampini   for (i=0;i<reuse->benign_n;i++) {
2559566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&reuse->benign_zerodiag_subs[i]));
256ca92afb2SStefano Zampini   }
2579566063dSJacob Faibussowitsch   PetscCall(PetscFree(reuse->benign_zerodiag_subs));
2589566063dSJacob Faibussowitsch   PetscCall(PetscFree(reuse->benign_save_vals));
2599566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&reuse->benign_csAIB));
2609566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&reuse->benign_AIIm1ones));
2619566063dSJacob Faibussowitsch   PetscCall(VecDestroy(&reuse->benign_corr_work));
2629566063dSJacob Faibussowitsch   PetscCall(VecDestroy(&reuse->benign_dummy_schur_vec));
263d62866d3SStefano Zampini   PetscFunctionReturn(0);
264d62866d3SStefano Zampini }
265d5574798SStefano Zampini 
2665ec10c6aSStefano Zampini static PetscErrorCode PCBDDCComputeExplicitSchur(Mat M, PetscBool issym, MatReuse reuse, Mat *S)
2673202ece2SStefano Zampini {
2683202ece2SStefano Zampini   Mat            B, C, D, Bd, Cd, AinvBd;
2693202ece2SStefano Zampini   KSP            ksp;
2703202ece2SStefano Zampini   PC             pc;
2713202ece2SStefano Zampini   PetscBool      isLU, isILU, isCHOL, Bdense, Cdense;
2723202ece2SStefano Zampini   PetscReal      fill = 2.0;
273f11841e3SStefano Zampini   PetscInt       n_I;
2743202ece2SStefano Zampini   PetscMPIInt    size;
2753202ece2SStefano Zampini 
2763202ece2SStefano Zampini   PetscFunctionBegin;
2779566063dSJacob Faibussowitsch   PetscCallMPI(MPI_Comm_size(PetscObjectComm((PetscObject)M),&size));
278*7827d75bSBarry Smith   PetscCheck(size == 1,PETSC_COMM_SELF,PETSC_ERR_SUP,"Not for parallel matrices");
279f11841e3SStefano Zampini   if (reuse == MAT_REUSE_MATRIX) {
280f11841e3SStefano Zampini     PetscBool Sdense;
281f11841e3SStefano Zampini 
2829566063dSJacob Faibussowitsch     PetscCall(PetscObjectTypeCompare((PetscObject)*S, MATSEQDENSE, &Sdense));
28328b400f6SJacob Faibussowitsch     PetscCheck(Sdense,PetscObjectComm((PetscObject)M),PETSC_ERR_SUP,"S should dense");
284f11841e3SStefano Zampini   }
2859566063dSJacob Faibussowitsch   PetscCall(MatSchurComplementGetSubMatrices(M, NULL, NULL, &B, &C, &D));
2869566063dSJacob Faibussowitsch   PetscCall(MatSchurComplementGetKSP(M, &ksp));
2879566063dSJacob Faibussowitsch   PetscCall(KSPGetPC(ksp, &pc));
2889566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject) pc, PCLU, &isLU));
2899566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject) pc, PCILU, &isILU));
2909566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject) pc, PCCHOLESKY, &isCHOL));
2919566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject) B, MATSEQDENSE, &Bdense));
2929566063dSJacob Faibussowitsch   PetscCall(PetscObjectTypeCompare((PetscObject) C, MATSEQDENSE, &Cdense));
2939566063dSJacob Faibussowitsch   PetscCall(MatGetSize(B,&n_I,NULL));
294f11841e3SStefano Zampini   if (n_I) {
2953202ece2SStefano Zampini     if (!Bdense) {
2969566063dSJacob Faibussowitsch       PetscCall(MatConvert(B, MATSEQDENSE, MAT_INITIAL_MATRIX, &Bd));
2973202ece2SStefano Zampini     } else {
2983202ece2SStefano Zampini       Bd = B;
2993202ece2SStefano Zampini     }
3003202ece2SStefano Zampini 
3013202ece2SStefano Zampini     if (isLU || isILU || isCHOL) {
3023202ece2SStefano Zampini       Mat fact;
3039566063dSJacob Faibussowitsch       PetscCall(KSPSetUp(ksp));
3049566063dSJacob Faibussowitsch       PetscCall(PCFactorGetMatrix(pc, &fact));
3059566063dSJacob Faibussowitsch       PetscCall(MatDuplicate(Bd, MAT_DO_NOT_COPY_VALUES, &AinvBd));
3069566063dSJacob Faibussowitsch       PetscCall(MatMatSolve(fact, Bd, AinvBd));
3073202ece2SStefano Zampini     } else {
30807b1e237SStefano Zampini       PetscBool ex = PETSC_TRUE;
30907b1e237SStefano Zampini 
31007b1e237SStefano Zampini       if (ex) {
3113202ece2SStefano Zampini         Mat Ainvd;
3123202ece2SStefano Zampini 
3139566063dSJacob Faibussowitsch         PetscCall(PCComputeOperator(pc, MATDENSE, &Ainvd));
3149566063dSJacob Faibussowitsch         PetscCall(MatMatMult(Ainvd, Bd, MAT_INITIAL_MATRIX, fill, &AinvBd));
3159566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&Ainvd));
31607b1e237SStefano Zampini       } else {
31707b1e237SStefano Zampini         Vec         sol,rhs;
31807b1e237SStefano Zampini         PetscScalar *arrayrhs,*arraysol;
31907b1e237SStefano Zampini         PetscInt    i,nrhs,n;
32007b1e237SStefano Zampini 
3219566063dSJacob Faibussowitsch         PetscCall(MatDuplicate(Bd, MAT_DO_NOT_COPY_VALUES, &AinvBd));
3229566063dSJacob Faibussowitsch         PetscCall(MatGetSize(Bd,&n,&nrhs));
3239566063dSJacob Faibussowitsch         PetscCall(MatDenseGetArray(Bd,&arrayrhs));
3249566063dSJacob Faibussowitsch         PetscCall(MatDenseGetArray(AinvBd,&arraysol));
3259566063dSJacob Faibussowitsch         PetscCall(KSPGetSolution(ksp,&sol));
3269566063dSJacob Faibussowitsch         PetscCall(KSPGetRhs(ksp,&rhs));
32707b1e237SStefano Zampini         for (i=0;i<nrhs;i++) {
3289566063dSJacob Faibussowitsch           PetscCall(VecPlaceArray(rhs,arrayrhs+i*n));
3299566063dSJacob Faibussowitsch           PetscCall(VecPlaceArray(sol,arraysol+i*n));
3309566063dSJacob Faibussowitsch           PetscCall(KSPSolve(ksp,rhs,sol));
3319566063dSJacob Faibussowitsch           PetscCall(VecResetArray(rhs));
3329566063dSJacob Faibussowitsch           PetscCall(VecResetArray(sol));
33307b1e237SStefano Zampini         }
3349566063dSJacob Faibussowitsch         PetscCall(MatDenseRestoreArray(Bd,&arrayrhs));
3359566063dSJacob Faibussowitsch         PetscCall(MatDenseRestoreArray(AinvBd,&arrayrhs));
33607b1e237SStefano Zampini       }
3373202ece2SStefano Zampini     }
3385ec10c6aSStefano Zampini     if (!Bdense & !issym) {
3399566063dSJacob Faibussowitsch       PetscCall(MatDestroy(&Bd));
3403202ece2SStefano Zampini     }
3415ec10c6aSStefano Zampini 
3425ec10c6aSStefano Zampini     if (!issym) {
3433202ece2SStefano Zampini       if (!Cdense) {
3449566063dSJacob Faibussowitsch         PetscCall(MatConvert(C, MATSEQDENSE, MAT_INITIAL_MATRIX, &Cd));
3453202ece2SStefano Zampini       } else {
3463202ece2SStefano Zampini         Cd = C;
3473202ece2SStefano Zampini       }
3489566063dSJacob Faibussowitsch       PetscCall(MatMatMult(Cd, AinvBd, reuse, fill, S));
3493202ece2SStefano Zampini       if (!Cdense) {
3509566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&Cd));
3513202ece2SStefano Zampini       }
3525ec10c6aSStefano Zampini     } else {
3539566063dSJacob Faibussowitsch       PetscCall(MatTransposeMatMult(Bd, AinvBd, reuse, fill, S));
3545ec10c6aSStefano Zampini       if (!Bdense) {
3559566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&Bd));
3565ec10c6aSStefano Zampini       }
3575ec10c6aSStefano Zampini     }
3589566063dSJacob Faibussowitsch     PetscCall(MatDestroy(&AinvBd));
359f11841e3SStefano Zampini   }
3603202ece2SStefano Zampini 
3613202ece2SStefano Zampini   if (D) {
3623202ece2SStefano Zampini     Mat       Dd;
3633202ece2SStefano Zampini     PetscBool Ddense;
3643202ece2SStefano Zampini 
3659566063dSJacob Faibussowitsch     PetscCall(PetscObjectTypeCompare((PetscObject)D,MATSEQDENSE,&Ddense));
3663202ece2SStefano Zampini     if (!Ddense) {
3679566063dSJacob Faibussowitsch       PetscCall(MatConvert(D, MATSEQDENSE, MAT_INITIAL_MATRIX, &Dd));
3683202ece2SStefano Zampini     } else {
3693202ece2SStefano Zampini       Dd = D;
3703202ece2SStefano Zampini     }
371f11841e3SStefano Zampini     if (n_I) {
3729566063dSJacob Faibussowitsch       PetscCall(MatAYPX(*S,-1.0,Dd,SAME_NONZERO_PATTERN));
373f11841e3SStefano Zampini     } else {
374f11841e3SStefano Zampini       if (reuse == MAT_INITIAL_MATRIX) {
3759566063dSJacob Faibussowitsch         PetscCall(MatDuplicate(Dd,MAT_COPY_VALUES,S));
376f11841e3SStefano Zampini       } else {
3779566063dSJacob Faibussowitsch         PetscCall(MatCopy(Dd,*S,SAME_NONZERO_PATTERN));
378f11841e3SStefano Zampini       }
379f11841e3SStefano Zampini     }
3803202ece2SStefano Zampini     if (!Ddense) {
3819566063dSJacob Faibussowitsch       PetscCall(MatDestroy(&Dd));
3823202ece2SStefano Zampini     }
3833202ece2SStefano Zampini   } else {
3849566063dSJacob Faibussowitsch     PetscCall(MatScale(*S,-1.0));
3853202ece2SStefano Zampini   }
3863202ece2SStefano Zampini   PetscFunctionReturn(0);
3873202ece2SStefano Zampini }
38834a97f8cSStefano Zampini 
38991af6908SStefano Zampini 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)
390b1b3d7a2SStefano Zampini {
391be83ff47SStefano Zampini   Mat                    F,A_II,A_IB,A_BI,A_BB,AE_II;
392be83ff47SStefano Zampini   Mat                    S_all;
39357a87bf3SStefano Zampini   Vec                    gstash,lstash;
39457a87bf3SStefano Zampini   VecScatter             sstash;
395b7ab4a40SStefano Zampini   IS                     is_I,is_I_layer;
396dc456d91SStefano Zampini   IS                     all_subsets,all_subsets_mult,all_subsets_n;
39757a87bf3SStefano Zampini   PetscScalar            *stasharray,*Bwork;
398dc456d91SStefano Zampini   PetscInt               *nnz,*all_local_idx_N;
399dc456d91SStefano Zampini   PetscInt               *auxnum1,*auxnum2;
4005a95e1ceSStefano Zampini   PetscInt               i,subset_size,max_subset_size;
401683d3df6SStefano Zampini   PetscInt               n_B,extra,local_size,global_size;
40257a87bf3SStefano Zampini   PetscInt               local_stash_size;
40308122e43SStefano Zampini   PetscBLASInt           B_N,B_ierr,B_lwork,*pivots;
4045a95e1ceSStefano Zampini   MPI_Comm               comm_n;
405f4f7d9d6SStefano Zampini   PetscBool              deluxe = PETSC_TRUE;
406f4f7d9d6SStefano Zampini   PetscBool              use_potr = PETSC_FALSE, use_sytr = PETSC_FALSE;
4073b03f7bbSStefano Zampini   PetscViewer            matl_dbg_viewer = NULL;
408b1b3d7a2SStefano Zampini   PetscErrorCode         ierr;
40935d0533cSStefano Zampini   PetscBool              flg;
410b1b3d7a2SStefano Zampini 
411b1b3d7a2SStefano Zampini   PetscFunctionBegin;
4129566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&sub_schurs->A));
4139566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&sub_schurs->S));
414e62b6521Sstefano_zampini   if (Ain) {
4159566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject)Ain));
416a64f4aa4SStefano Zampini     sub_schurs->A = Ain;
417a64f4aa4SStefano Zampini   }
4183301b35fSStefano Zampini 
4199566063dSJacob Faibussowitsch   PetscCall(PetscObjectReference((PetscObject)Sin));
420a64f4aa4SStefano Zampini   sub_schurs->S = Sin;
421df4d28bfSStefano Zampini   if (sub_schurs->schur_explicit) {
422df4d28bfSStefano Zampini     sub_schurs->schur_explicit = (PetscBool)(!!sub_schurs->A);
423a64f4aa4SStefano Zampini   }
424a64f4aa4SStefano Zampini 
4255a95e1ceSStefano Zampini   /* preliminary checks */
426*7827d75bSBarry Smith   PetscCheck(sub_schurs->schur_explicit || !compute_Stilda,PetscObjectComm((PetscObject)sub_schurs->l2gmap),PETSC_ERR_SUP,"Adaptive selection of constraints requires MUMPS and/or MKL_PARDISO");
4275a95e1ceSStefano Zampini 
42888113c35SStefano Zampini   if (benign_trick) sub_schurs->is_posdef = PETSC_FALSE;
42988113c35SStefano Zampini 
4303b03f7bbSStefano Zampini   /* debug (MATLAB) */
4317f9db97bSStefano Zampini   if (sub_schurs->debug) {
4327f9db97bSStefano Zampini     PetscMPIInt size,rank;
4337ebab0bbSStefano Zampini     PetscInt    nr,*print_schurs_ranks,print_schurs = PETSC_FALSE;
4347f9db97bSStefano Zampini 
4359566063dSJacob Faibussowitsch     PetscCallMPI(MPI_Comm_size(PetscObjectComm((PetscObject)sub_schurs->l2gmap),&size));
4369566063dSJacob Faibussowitsch     PetscCallMPI(MPI_Comm_rank(PetscObjectComm((PetscObject)sub_schurs->l2gmap),&rank));
4377f9db97bSStefano Zampini     nr   = size;
4389566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(nr,&print_schurs_ranks));
4399566063dSJacob Faibussowitsch     ierr = PetscOptionsBegin(PetscObjectComm((PetscObject)sub_schurs->l2gmap),sub_schurs->prefix,"BDDC sub_schurs options","PC");PetscCall(ierr);
4409566063dSJacob Faibussowitsch     PetscCall(PetscOptionsIntArray("-sub_schurs_debug_ranks","Ranks to debug (all if the option is not used)",NULL,print_schurs_ranks,&nr,&flg));
4417f9db97bSStefano Zampini     if (!flg) print_schurs = PETSC_TRUE;
4427f9db97bSStefano Zampini     else {
4437ebab0bbSStefano Zampini       print_schurs = PETSC_FALSE;
4447f9db97bSStefano Zampini       for (i=0;i<nr;i++) if (print_schurs_ranks[i] == (PetscInt)rank) { print_schurs = PETSC_TRUE; break; }
4457f9db97bSStefano Zampini     }
4469566063dSJacob Faibussowitsch     ierr = PetscOptionsEnd();PetscCall(ierr);
4479566063dSJacob Faibussowitsch     PetscCall(PetscFree(print_schurs_ranks));
4483b03f7bbSStefano Zampini     if (print_schurs) {
4493b03f7bbSStefano Zampini       char filename[256];
4503b03f7bbSStefano Zampini 
4519566063dSJacob Faibussowitsch       PetscCall(PetscSNPrintf(filename,sizeof(filename),"sub_schurs_Schur_r%d.m",PetscGlobalRank));
4529566063dSJacob Faibussowitsch       PetscCall(PetscViewerASCIIOpen(PETSC_COMM_SELF,filename,&matl_dbg_viewer));
4539566063dSJacob Faibussowitsch       PetscCall(PetscViewerPushFormat(matl_dbg_viewer,PETSC_VIEWER_ASCII_MATLAB));
4543b03f7bbSStefano Zampini     }
4557f9db97bSStefano Zampini   }
4567f9db97bSStefano Zampini 
4575a95e1ceSStefano Zampini   /* restrict work on active processes */
458991c41b4SStefano Zampini   if (sub_schurs->restrict_comm) {
459991c41b4SStefano Zampini     PetscSubcomm subcomm;
460991c41b4SStefano Zampini     PetscMPIInt  color,rank;
461991c41b4SStefano Zampini 
4625a95e1ceSStefano Zampini     color = 0;
4635a95e1ceSStefano Zampini     if (!sub_schurs->n_subs) color = 1; /* this can happen if we are in a multilevel case or if the subdomain is disconnected */
4649566063dSJacob Faibussowitsch     PetscCallMPI(MPI_Comm_rank(PetscObjectComm((PetscObject)sub_schurs->l2gmap),&rank));
4659566063dSJacob Faibussowitsch     PetscCall(PetscSubcommCreate(PetscObjectComm((PetscObject)sub_schurs->l2gmap),&subcomm));
4669566063dSJacob Faibussowitsch     PetscCall(PetscSubcommSetNumber(subcomm,2));
4679566063dSJacob Faibussowitsch     PetscCall(PetscSubcommSetTypeGeneral(subcomm,color,rank));
4689566063dSJacob Faibussowitsch     PetscCall(PetscCommDuplicate(PetscSubcommChild(subcomm),&comm_n,NULL));
4699566063dSJacob Faibussowitsch     PetscCall(PetscSubcommDestroy(&subcomm));
4705a95e1ceSStefano Zampini     if (!sub_schurs->n_subs) {
4719566063dSJacob Faibussowitsch       PetscCall(PetscCommDestroy(&comm_n));
4725a95e1ceSStefano Zampini       PetscFunctionReturn(0);
4735a95e1ceSStefano Zampini     }
474991c41b4SStefano Zampini   } else {
4759566063dSJacob Faibussowitsch     PetscCall(PetscCommDuplicate(PetscObjectComm((PetscObject)sub_schurs->l2gmap),&comm_n,NULL));
476991c41b4SStefano Zampini   }
4775a95e1ceSStefano Zampini 
478b1b3d7a2SStefano Zampini   /* get Schur complement matrices */
479df4d28bfSStefano Zampini   if (!sub_schurs->schur_explicit) {
480a64f4aa4SStefano Zampini     Mat       tA_IB,tA_BI,tA_BB;
4813301b35fSStefano Zampini     PetscBool isseqsbaij;
4829566063dSJacob Faibussowitsch     PetscCall(MatSchurComplementGetSubMatrices(sub_schurs->S,&A_II,NULL,&tA_IB,&tA_BI,&tA_BB));
4839566063dSJacob Faibussowitsch     PetscCall(PetscObjectTypeCompare((PetscObject)tA_BB,MATSEQSBAIJ,&isseqsbaij));
4843301b35fSStefano Zampini     if (isseqsbaij) {
4859566063dSJacob Faibussowitsch       PetscCall(MatConvert(tA_BB,MATSEQAIJ,MAT_INITIAL_MATRIX,&A_BB));
4869566063dSJacob Faibussowitsch       PetscCall(MatConvert(tA_IB,MATSEQAIJ,MAT_INITIAL_MATRIX,&A_IB));
4879566063dSJacob Faibussowitsch       PetscCall(MatConvert(tA_BI,MATSEQAIJ,MAT_INITIAL_MATRIX,&A_BI));
488a64f4aa4SStefano Zampini     } else {
4899566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)tA_BB));
490a64f4aa4SStefano Zampini       A_BB = tA_BB;
4919566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)tA_IB));
492a64f4aa4SStefano Zampini       A_IB = tA_IB;
4939566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)tA_BI));
494a64f4aa4SStefano Zampini       A_BI = tA_BI;
495f11841e3SStefano Zampini     }
496a58a30b4SStefano Zampini   } else {
4975a95e1ceSStefano Zampini     A_II = NULL;
4985a95e1ceSStefano Zampini     A_IB = NULL;
4995a95e1ceSStefano Zampini     A_BI = NULL;
5005a95e1ceSStefano Zampini     A_BB = NULL;
501b1b3d7a2SStefano Zampini   }
5025a95e1ceSStefano Zampini   S_all = NULL;
503b1b3d7a2SStefano Zampini 
504b1b3d7a2SStefano Zampini   /* determine interior problems */
5059566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(sub_schurs->is_I,&i));
5063dc780c3SStefano Zampini   if (nlayers >= 0 && i) { /* Interior problems can be different from the original one */
507b1b3d7a2SStefano Zampini     PetscBT                touched;
508b1b3d7a2SStefano Zampini     const PetscInt*        idx_B;
509b1b3d7a2SStefano Zampini     PetscInt               n_I,n_B,n_local_dofs,n_prev_added,j,layer,*local_numbering;
510b1b3d7a2SStefano Zampini 
51128b400f6SJacob Faibussowitsch     PetscCheck(xadj,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Cannot request layering without adjacency");
512b1b3d7a2SStefano Zampini     /* get sizes */
5139566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(sub_schurs->is_I,&n_I));
5149566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(sub_schurs->is_B,&n_B));
515b1b3d7a2SStefano Zampini 
5169566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(n_I+n_B,&local_numbering));
5179566063dSJacob Faibussowitsch     PetscCall(PetscBTCreate(n_I+n_B,&touched));
5189566063dSJacob Faibussowitsch     PetscCall(PetscBTMemzero(n_I+n_B,touched));
519b1b3d7a2SStefano Zampini 
520b1b3d7a2SStefano Zampini     /* all boundary dofs must be skipped when adding layers */
5219566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(sub_schurs->is_B,&idx_B));
522b1b3d7a2SStefano Zampini     for (j=0;j<n_B;j++) {
5239566063dSJacob Faibussowitsch       PetscCall(PetscBTSet(touched,idx_B[j]));
524b1b3d7a2SStefano Zampini     }
5259566063dSJacob Faibussowitsch     PetscCall(PetscArraycpy(local_numbering,idx_B,n_B));
5269566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(sub_schurs->is_B,&idx_B));
527b1b3d7a2SStefano Zampini 
528b1b3d7a2SStefano Zampini     /* add prescribed number of layers of dofs */
529b1b3d7a2SStefano Zampini     n_local_dofs = n_B;
530b1b3d7a2SStefano Zampini     n_prev_added = n_B;
531b1b3d7a2SStefano Zampini     for (layer=0;layer<nlayers;layer++) {
532b6bace71SJacob Faibussowitsch       PetscInt n_added = 0;
533b1b3d7a2SStefano Zampini       if (n_local_dofs == n_I+n_B) break;
5342c71b3e2SJacob Faibussowitsch       PetscCheckFalse(n_local_dofs > n_I+n_B,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Error querying layer %D. Out of bound access (%D > %D)",layer,n_local_dofs,n_I+n_B);
5359566063dSJacob Faibussowitsch       PetscCall(PCBDDCAdjGetNextLayer_Private(local_numbering+n_local_dofs,n_prev_added,touched,xadj,adjncy,&n_added));
536b1b3d7a2SStefano Zampini       n_prev_added = n_added;
537b1b3d7a2SStefano Zampini       n_local_dofs += n_added;
538b1b3d7a2SStefano Zampini       if (!n_added) break;
539b1b3d7a2SStefano Zampini     }
5409566063dSJacob Faibussowitsch     PetscCall(PetscBTDestroy(&touched));
541b1b3d7a2SStefano Zampini 
542883469d8SStefano Zampini     /* IS for I layer dofs in original numbering */
5439566063dSJacob Faibussowitsch     PetscCall(ISCreateGeneral(PetscObjectComm((PetscObject)sub_schurs->is_I),n_local_dofs-n_B,local_numbering+n_B,PETSC_COPY_VALUES,&is_I_layer));
5449566063dSJacob Faibussowitsch     PetscCall(PetscFree(local_numbering));
5459566063dSJacob Faibussowitsch     PetscCall(ISSort(is_I_layer));
546883469d8SStefano Zampini     /* IS for I layer dofs in I numbering */
547df4d28bfSStefano Zampini     if (!sub_schurs->schur_explicit) {
548b1b3d7a2SStefano Zampini       ISLocalToGlobalMapping ItoNmap;
5499566063dSJacob Faibussowitsch       PetscCall(ISLocalToGlobalMappingCreateIS(sub_schurs->is_I,&ItoNmap));
5509566063dSJacob Faibussowitsch       PetscCall(ISGlobalToLocalMappingApplyIS(ItoNmap,IS_GTOLM_DROP,is_I_layer,&is_I));
5519566063dSJacob Faibussowitsch       PetscCall(ISLocalToGlobalMappingDestroy(&ItoNmap));
552b1b3d7a2SStefano Zampini 
553b1b3d7a2SStefano Zampini       /* II block */
5549566063dSJacob Faibussowitsch       PetscCall(MatCreateSubMatrix(A_II,is_I,is_I,MAT_INITIAL_MATRIX,&AE_II));
555b1b3d7a2SStefano Zampini     }
556b1b3d7a2SStefano Zampini   } else {
557b1b3d7a2SStefano Zampini     PetscInt n_I;
558b1b3d7a2SStefano Zampini 
559b1b3d7a2SStefano Zampini     /* IS for I dofs in original numbering */
5609566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject)sub_schurs->is_I));
561a9b99552SStefano Zampini     is_I_layer = sub_schurs->is_I;
562b1b3d7a2SStefano Zampini 
563b1b3d7a2SStefano Zampini     /* IS for I dofs in I numbering (strided 1) */
564df4d28bfSStefano Zampini     if (!sub_schurs->schur_explicit) {
5659566063dSJacob Faibussowitsch       PetscCall(ISGetSize(sub_schurs->is_I,&n_I));
5669566063dSJacob Faibussowitsch       PetscCall(ISCreateStride(PetscObjectComm((PetscObject)sub_schurs->is_I),n_I,0,1,&is_I));
567b1b3d7a2SStefano Zampini 
568b1b3d7a2SStefano Zampini       /* II block is the same */
5699566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)A_II));
570b1b3d7a2SStefano Zampini       AE_II = A_II;
571b1b3d7a2SStefano Zampini     }
572b1b3d7a2SStefano Zampini   }
5735a95e1ceSStefano Zampini 
574883469d8SStefano Zampini   /* Get info on subset sizes and sum of all subsets sizes */
5755a95e1ceSStefano Zampini   max_subset_size = 0;
576883469d8SStefano Zampini   local_size = 0;
5775a95e1ceSStefano Zampini   for (i=0;i<sub_schurs->n_subs;i++) {
5789566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(sub_schurs->is_subs[i],&subset_size));
5795a95e1ceSStefano Zampini     max_subset_size = PetscMax(subset_size,max_subset_size);
580883469d8SStefano Zampini     local_size += subset_size;
581883469d8SStefano Zampini   }
582883469d8SStefano Zampini 
583883469d8SStefano Zampini   /* Work arrays for local indices */
584883469d8SStefano Zampini   extra = 0;
5859566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(sub_schurs->is_B,&n_B));
586df4d28bfSStefano Zampini   if (sub_schurs->schur_explicit && is_I_layer) {
5879566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(is_I_layer,&extra));
588883469d8SStefano Zampini   }
5899566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(n_B+extra,&all_local_idx_N));
590883469d8SStefano Zampini   if (extra) {
591883469d8SStefano Zampini     const PetscInt *idxs;
5929566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(is_I_layer,&idxs));
5939566063dSJacob Faibussowitsch     PetscCall(PetscArraycpy(all_local_idx_N,idxs,extra));
5949566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(is_I_layer,&idxs));
595883469d8SStefano Zampini   }
5969566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(sub_schurs->n_subs,&auxnum1));
5979566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(sub_schurs->n_subs,&auxnum2));
598883469d8SStefano Zampini 
599883469d8SStefano Zampini   /* Get local indices in local numbering */
600883469d8SStefano Zampini   local_size = 0;
60157a87bf3SStefano Zampini   local_stash_size = 0;
6025a95e1ceSStefano Zampini   for (i=0;i<sub_schurs->n_subs;i++) {
603883469d8SStefano Zampini     const PetscInt *idxs;
604883469d8SStefano Zampini 
6059566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(sub_schurs->is_subs[i],&subset_size));
6069566063dSJacob Faibussowitsch     PetscCall(ISGetIndices(sub_schurs->is_subs[i],&idxs));
607eb595f79SStefano Zampini     /* start (smallest in global ordering) and multiplicity */
608eb595f79SStefano Zampini     auxnum1[i] = idxs[0];
60957a87bf3SStefano Zampini     auxnum2[i] = subset_size*subset_size;
610883469d8SStefano Zampini     /* subset indices in local numbering */
6119566063dSJacob Faibussowitsch     PetscCall(PetscArraycpy(all_local_idx_N+local_size+extra,idxs,subset_size));
6129566063dSJacob Faibussowitsch     PetscCall(ISRestoreIndices(sub_schurs->is_subs[i],&idxs));
613883469d8SStefano Zampini     local_size += subset_size;
61457a87bf3SStefano Zampini     local_stash_size += subset_size*subset_size;
615883469d8SStefano Zampini   }
616883469d8SStefano Zampini 
617f4f7d9d6SStefano Zampini   /* allocate extra workspace needed only for GETRI or SYTRF */
61811955456SStefano Zampini   use_potr = use_sytr = PETSC_FALSE;
61911955456SStefano Zampini   if (benign_trick || (sub_schurs->is_hermitian && sub_schurs->is_posdef)) {
620f4f7d9d6SStefano Zampini     use_potr = PETSC_TRUE;
62111955456SStefano Zampini   } else if (sub_schurs->is_symmetric) {
62211955456SStefano Zampini     use_sytr = PETSC_TRUE;
62311955456SStefano Zampini   }
62411955456SStefano Zampini   if (local_size && !use_potr) {
62559ac4de7SStefano Zampini     PetscScalar  lwork,dummyscalar = 0.;
62659ac4de7SStefano Zampini     PetscBLASInt dummyint = 0;
627d2627357SStefano Zampini 
628d2627357SStefano Zampini     B_lwork = -1;
6299566063dSJacob Faibussowitsch     PetscCall(PetscBLASIntCast(local_size,&B_N));
6309566063dSJacob Faibussowitsch     PetscCall(PetscFPTrapPush(PETSC_FP_TRAP_OFF));
631f4f7d9d6SStefano Zampini     if (use_sytr) {
632f4f7d9d6SStefano Zampini       PetscStackCallBLAS("LAPACKsytrf",LAPACKsytrf_("L",&B_N,&dummyscalar,&B_N,&dummyint,&lwork,&B_lwork,&B_ierr));
63328b400f6SJacob Faibussowitsch       PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in query to SYTRF Lapack routine %d",(int)B_ierr);
634f4f7d9d6SStefano Zampini     } else {
63559ac4de7SStefano Zampini       PetscStackCallBLAS("LAPACKgetri",LAPACKgetri_(&B_N,&dummyscalar,&B_N,&dummyint,&lwork,&B_lwork,&B_ierr));
63628b400f6SJacob Faibussowitsch       PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in query to GETRI Lapack routine %d",(int)B_ierr);
637f4f7d9d6SStefano Zampini     }
6389566063dSJacob Faibussowitsch     PetscCall(PetscFPTrapPop());
6399566063dSJacob Faibussowitsch     PetscCall(PetscBLASIntCast((PetscInt)PetscRealPart(lwork),&B_lwork));
6409566063dSJacob Faibussowitsch     PetscCall(PetscMalloc2(B_lwork,&Bwork,B_N,&pivots));
641056290a2SStefano Zampini   } else {
642056290a2SStefano Zampini     Bwork = NULL;
643056290a2SStefano Zampini     pivots = NULL;
644d2627357SStefano Zampini   }
645d2627357SStefano Zampini 
64657a87bf3SStefano Zampini   /* prepare data for summing up properly schurs on subsets */
6479566063dSJacob Faibussowitsch   PetscCall(ISCreateGeneral(comm_n,sub_schurs->n_subs,auxnum1,PETSC_OWN_POINTER,&all_subsets_n));
6489566063dSJacob Faibussowitsch   PetscCall(ISLocalToGlobalMappingApplyIS(sub_schurs->l2gmap,all_subsets_n,&all_subsets));
6499566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&all_subsets_n));
6509566063dSJacob Faibussowitsch   PetscCall(ISCreateGeneral(comm_n,sub_schurs->n_subs,auxnum2,PETSC_OWN_POINTER,&all_subsets_mult));
6519566063dSJacob Faibussowitsch   PetscCall(ISRenumber(all_subsets,all_subsets_mult,&global_size,&all_subsets_n));
6529566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&all_subsets));
6539566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&all_subsets_mult));
6549566063dSJacob Faibussowitsch   PetscCall(ISGetLocalSize(all_subsets_n,&i));
6552c71b3e2SJacob Faibussowitsch   PetscCheckFalse(i != local_stash_size,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Invalid size of new subset! %D != %D",i,local_stash_size);
6569566063dSJacob Faibussowitsch   PetscCall(VecCreateSeqWithArray(PETSC_COMM_SELF,1,local_stash_size,NULL,&lstash));
6579566063dSJacob Faibussowitsch   PetscCall(VecCreateMPI(comm_n,PETSC_DECIDE,global_size,&gstash));
6589566063dSJacob Faibussowitsch   PetscCall(VecScatterCreate(lstash,NULL,gstash,all_subsets_n,&sstash));
6599566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&all_subsets_n));
6602972d61bSStefano Zampini 
6615a95e1ceSStefano Zampini   /* subset indices in local boundary numbering */
6625a95e1ceSStefano Zampini   if (!sub_schurs->is_Ej_all) {
6635a95e1ceSStefano Zampini     PetscInt *all_local_idx_B;
6645a95e1ceSStefano Zampini 
6659566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(local_size,&all_local_idx_B));
6669566063dSJacob Faibussowitsch     PetscCall(ISGlobalToLocalMappingApply(sub_schurs->BtoNmap,IS_GTOLM_DROP,local_size,all_local_idx_N+extra,&subset_size,all_local_idx_B));
6672c71b3e2SJacob Faibussowitsch     PetscCheckFalse(subset_size != local_size,PETSC_COMM_SELF,PETSC_ERR_PLIB,"Error in sub_schurs serial (BtoNmap)! %D != %D",subset_size,local_size);
6689566063dSJacob Faibussowitsch     PetscCall(ISCreateGeneral(PETSC_COMM_SELF,local_size,all_local_idx_B,PETSC_OWN_POINTER,&sub_schurs->is_Ej_all));
669b1b3d7a2SStefano Zampini   }
670b1b3d7a2SStefano Zampini 
67172b8c272SStefano Zampini   if (change) {
67272b8c272SStefano Zampini     ISLocalToGlobalMapping BtoS;
67372b8c272SStefano Zampini     IS                     change_primal_B;
67472b8c272SStefano Zampini     IS                     change_primal_all;
67572b8c272SStefano Zampini 
67628b400f6SJacob Faibussowitsch     PetscCheck(!sub_schurs->change_primal_sub,PETSC_COMM_SELF,PETSC_ERR_PLIB,"This should not happen");
67728b400f6SJacob Faibussowitsch     PetscCheck(!sub_schurs->change,PETSC_COMM_SELF,PETSC_ERR_PLIB,"This should not happen");
6789566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(sub_schurs->n_subs,&sub_schurs->change_primal_sub));
67972b8c272SStefano Zampini     for (i=0;i<sub_schurs->n_subs;i++) {
68072b8c272SStefano Zampini       ISLocalToGlobalMapping NtoS;
6819566063dSJacob Faibussowitsch       PetscCall(ISLocalToGlobalMappingCreateIS(sub_schurs->is_subs[i],&NtoS));
6829566063dSJacob Faibussowitsch       PetscCall(ISGlobalToLocalMappingApplyIS(NtoS,IS_GTOLM_DROP,change_primal,&sub_schurs->change_primal_sub[i]));
6839566063dSJacob Faibussowitsch       PetscCall(ISLocalToGlobalMappingDestroy(&NtoS));
68472b8c272SStefano Zampini     }
6859566063dSJacob Faibussowitsch     PetscCall(ISGlobalToLocalMappingApplyIS(sub_schurs->BtoNmap,IS_GTOLM_DROP,change_primal,&change_primal_B));
6869566063dSJacob Faibussowitsch     PetscCall(ISLocalToGlobalMappingCreateIS(sub_schurs->is_Ej_all,&BtoS));
6879566063dSJacob Faibussowitsch     PetscCall(ISGlobalToLocalMappingApplyIS(BtoS,IS_GTOLM_DROP,change_primal_B,&change_primal_all));
6889566063dSJacob Faibussowitsch     PetscCall(ISLocalToGlobalMappingDestroy(&BtoS));
6899566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&change_primal_B));
6909566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(sub_schurs->n_subs,&sub_schurs->change));
69172b8c272SStefano Zampini     for (i=0;i<sub_schurs->n_subs;i++) {
69272b8c272SStefano Zampini       Mat change_sub;
69372b8c272SStefano Zampini 
6949566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(sub_schurs->is_subs[i],&subset_size));
6959566063dSJacob Faibussowitsch       PetscCall(KSPCreate(PETSC_COMM_SELF,&sub_schurs->change[i]));
6969566063dSJacob Faibussowitsch       PetscCall(KSPSetType(sub_schurs->change[i],KSPPREONLY));
69772b8c272SStefano Zampini       if (!sub_schurs->change_with_qr) {
6989566063dSJacob Faibussowitsch         PetscCall(MatCreateSubMatrix(change,sub_schurs->is_subs[i],sub_schurs->is_subs[i],MAT_INITIAL_MATRIX,&change_sub));
69972b8c272SStefano Zampini       } else {
70072b8c272SStefano Zampini         Mat change_subt;
7019566063dSJacob Faibussowitsch         PetscCall(MatCreateSubMatrix(change,sub_schurs->is_subs[i],sub_schurs->is_subs[i],MAT_INITIAL_MATRIX,&change_subt));
7029566063dSJacob Faibussowitsch         PetscCall(MatConvert(change_subt,MATSEQDENSE,MAT_INITIAL_MATRIX,&change_sub));
7039566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&change_subt));
70472b8c272SStefano Zampini       }
7059566063dSJacob Faibussowitsch       PetscCall(KSPSetOperators(sub_schurs->change[i],change_sub,change_sub));
7069566063dSJacob Faibussowitsch       PetscCall(MatDestroy(&change_sub));
7079566063dSJacob Faibussowitsch       PetscCall(KSPSetOptionsPrefix(sub_schurs->change[i],sub_schurs->prefix));
7089566063dSJacob Faibussowitsch       PetscCall(KSPAppendOptionsPrefix(sub_schurs->change[i],"sub_schurs_change_"));
70972b8c272SStefano Zampini     }
7109566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&change_primal_all));
71172b8c272SStefano Zampini   }
71272b8c272SStefano Zampini 
7135a95e1ceSStefano Zampini   /* Local matrix of all local Schur on subsets (transposed) */
7145a95e1ceSStefano Zampini   if (!sub_schurs->S_Ej_all) {
71504c5b2e6SStefano Zampini     Mat         T;
71604c5b2e6SStefano Zampini     PetscScalar *v;
71704c5b2e6SStefano Zampini     PetscInt    *ii,*jj;
71804c5b2e6SStefano Zampini     PetscInt    cum,i,j,k;
71904c5b2e6SStefano Zampini 
72004c5b2e6SStefano Zampini     /* MatSeqAIJSetPreallocation + MatSetValues is slow for these kind of matrices (may have large blocks)
72104c5b2e6SStefano Zampini        Allocate properly a representative matrix and duplicate */
7229566063dSJacob Faibussowitsch     PetscCall(PetscMalloc3(local_size+1,&ii,local_stash_size,&jj,local_stash_size,&v));
72304c5b2e6SStefano Zampini     ii[0] = 0;
72404c5b2e6SStefano Zampini     cum   = 0;
72504c5b2e6SStefano Zampini     for (i=0;i<sub_schurs->n_subs;i++) {
7269566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(sub_schurs->is_subs[i],&subset_size));
72704c5b2e6SStefano Zampini       for (j=0;j<subset_size;j++) {
72804c5b2e6SStefano Zampini         const PetscInt row = cum+j;
72904c5b2e6SStefano Zampini         PetscInt col = cum;
73004c5b2e6SStefano Zampini 
73104c5b2e6SStefano Zampini         ii[row+1] = ii[row] + subset_size;
73204c5b2e6SStefano Zampini         for (k=ii[row];k<ii[row+1];k++) {
73304c5b2e6SStefano Zampini           jj[k] = col;
73404c5b2e6SStefano Zampini           col++;
73504c5b2e6SStefano Zampini         }
73604c5b2e6SStefano Zampini       }
73704c5b2e6SStefano Zampini       cum += subset_size;
73804c5b2e6SStefano Zampini     }
7399566063dSJacob Faibussowitsch     PetscCall(MatCreateSeqAIJWithArrays(PETSC_COMM_SELF,local_size,local_size,ii,jj,v,&T));
7409566063dSJacob Faibussowitsch     PetscCall(MatDuplicate(T,MAT_DO_NOT_COPY_VALUES,&sub_schurs->S_Ej_all));
7419566063dSJacob Faibussowitsch     PetscCall(MatDestroy(&T));
7429566063dSJacob Faibussowitsch     PetscCall(PetscFree3(ii,jj,v));
74304c5b2e6SStefano Zampini   }
74404c5b2e6SStefano Zampini   /* matrices for deluxe scaling and adaptive selection */
74504c5b2e6SStefano Zampini   if (compute_Stilda) {
74604c5b2e6SStefano Zampini     if (!sub_schurs->sum_S_Ej_tilda_all) {
7479566063dSJacob Faibussowitsch       PetscCall(MatDuplicate(sub_schurs->S_Ej_all,MAT_DO_NOT_COPY_VALUES,&sub_schurs->sum_S_Ej_tilda_all));
74804c5b2e6SStefano Zampini     }
74904c5b2e6SStefano Zampini     if (!sub_schurs->sum_S_Ej_inv_all && deluxe) {
7509566063dSJacob Faibussowitsch       PetscCall(MatDuplicate(sub_schurs->S_Ej_all,MAT_DO_NOT_COPY_VALUES,&sub_schurs->sum_S_Ej_inv_all));
75104c5b2e6SStefano Zampini     }
752aa83b6aeSStefano Zampini   }
753b1b3d7a2SStefano Zampini 
7545a95e1ceSStefano Zampini   /* Compute Schur complements explicitly */
755be83ff47SStefano Zampini   F = NULL;
756d943a642SStefano Zampini   if (!sub_schurs->schur_explicit) {
757d943a642SStefano Zampini     /* this code branch is used when MatFactor with Schur complement support is not present or when explicitly requested;
758d943a642SStefano Zampini        it is not efficient, unless the economic version of the scaling is used */
7595a95e1ceSStefano Zampini     Mat         S_Ej_expl;
7605a95e1ceSStefano Zampini     PetscScalar *work;
7615a95e1ceSStefano Zampini     PetscInt    j,*dummy_idx;
7625a95e1ceSStefano Zampini     PetscBool   Sdense;
7635a95e1ceSStefano Zampini 
7649566063dSJacob Faibussowitsch     PetscCall(PetscMalloc2(max_subset_size,&dummy_idx,max_subset_size*max_subset_size,&work));
7655a95e1ceSStefano Zampini     local_size = 0;
766b1b3d7a2SStefano Zampini     for (i=0;i<sub_schurs->n_subs;i++) {
7675a95e1ceSStefano Zampini       IS  is_subset_B;
7685a95e1ceSStefano Zampini       Mat AE_EE,AE_IE,AE_EI,S_Ej;
7695a95e1ceSStefano Zampini 
7705a95e1ceSStefano Zampini       /* subsets in original and boundary numbering */
7719566063dSJacob Faibussowitsch       PetscCall(ISGlobalToLocalMappingApplyIS(sub_schurs->BtoNmap,IS_GTOLM_DROP,sub_schurs->is_subs[i],&is_subset_B));
7725a95e1ceSStefano Zampini       /* EE block */
7739566063dSJacob Faibussowitsch       PetscCall(MatCreateSubMatrix(A_BB,is_subset_B,is_subset_B,MAT_INITIAL_MATRIX,&AE_EE));
7745a95e1ceSStefano Zampini       /* IE block */
7759566063dSJacob Faibussowitsch       PetscCall(MatCreateSubMatrix(A_IB,is_I,is_subset_B,MAT_INITIAL_MATRIX,&AE_IE));
7765a95e1ceSStefano Zampini       /* EI block */
777d943a642SStefano Zampini       if (sub_schurs->is_symmetric) {
7789566063dSJacob Faibussowitsch         PetscCall(MatCreateTranspose(AE_IE,&AE_EI));
779d943a642SStefano Zampini       } else if (sub_schurs->is_hermitian) {
7809566063dSJacob Faibussowitsch         PetscCall(MatCreateHermitianTranspose(AE_IE,&AE_EI));
7815a95e1ceSStefano Zampini       } else {
7829566063dSJacob Faibussowitsch         PetscCall(MatCreateSubMatrix(A_BI,is_subset_B,is_I,MAT_INITIAL_MATRIX,&AE_EI));
7835a95e1ceSStefano Zampini       }
7849566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&is_subset_B));
7859566063dSJacob Faibussowitsch       PetscCall(MatCreateSchurComplement(AE_II,AE_II,AE_IE,AE_EI,AE_EE,&S_Ej));
7869566063dSJacob Faibussowitsch       PetscCall(MatDestroy(&AE_EE));
7879566063dSJacob Faibussowitsch       PetscCall(MatDestroy(&AE_IE));
7889566063dSJacob Faibussowitsch       PetscCall(MatDestroy(&AE_EI));
789b1b3d7a2SStefano Zampini       if (AE_II == A_II) { /* we can reuse the same ksp */
790b1b3d7a2SStefano Zampini         KSP ksp;
7919566063dSJacob Faibussowitsch         PetscCall(MatSchurComplementGetKSP(sub_schurs->S,&ksp));
7929566063dSJacob Faibussowitsch         PetscCall(MatSchurComplementSetKSP(S_Ej,ksp));
793b1b3d7a2SStefano Zampini       } else { /* build new ksp object which inherits ksp and pc types from the original one */
794b1b3d7a2SStefano Zampini         KSP       origksp,schurksp;
795b1b3d7a2SStefano Zampini         PC        origpc,schurpc;
796b1b3d7a2SStefano Zampini         KSPType   ksp_type;
797b1b3d7a2SStefano Zampini         PetscInt  n_internal;
7985a95e1ceSStefano Zampini         PetscBool ispcnone;
799b1b3d7a2SStefano Zampini 
8009566063dSJacob Faibussowitsch         PetscCall(MatSchurComplementGetKSP(sub_schurs->S,&origksp));
8019566063dSJacob Faibussowitsch         PetscCall(MatSchurComplementGetKSP(S_Ej,&schurksp));
8029566063dSJacob Faibussowitsch         PetscCall(KSPGetType(origksp,&ksp_type));
8039566063dSJacob Faibussowitsch         PetscCall(KSPSetType(schurksp,ksp_type));
8049566063dSJacob Faibussowitsch         PetscCall(KSPGetPC(schurksp,&schurpc));
8059566063dSJacob Faibussowitsch         PetscCall(KSPGetPC(origksp,&origpc));
8069566063dSJacob Faibussowitsch         PetscCall(PetscObjectTypeCompare((PetscObject)origpc,PCNONE,&ispcnone));
8075a95e1ceSStefano Zampini         if (!ispcnone) {
8085a95e1ceSStefano Zampini           PCType pc_type;
8099566063dSJacob Faibussowitsch           PetscCall(PCGetType(origpc,&pc_type));
8109566063dSJacob Faibussowitsch           PetscCall(PCSetType(schurpc,pc_type));
8115a95e1ceSStefano Zampini         } else {
8129566063dSJacob Faibussowitsch           PetscCall(PCSetType(schurpc,PCLU));
8135a95e1ceSStefano Zampini         }
8149566063dSJacob Faibussowitsch         PetscCall(ISGetSize(is_I,&n_internal));
815365a3a41SStefano Zampini         if (!n_internal) { /* UMFPACK gives error with 0 sized problems */
8163ca39a21SBarry Smith           MatSolverType solver = NULL;
8179566063dSJacob Faibussowitsch           PetscCall(PCFactorGetMatSolverType(origpc,(MatSolverType*)&solver));
818b1b3d7a2SStefano Zampini           if (solver) {
8199566063dSJacob Faibussowitsch             PetscCall(PCFactorSetMatSolverType(schurpc,solver));
820b1b3d7a2SStefano Zampini           }
821b1b3d7a2SStefano Zampini         }
8229566063dSJacob Faibussowitsch         PetscCall(KSPSetUp(schurksp));
823b1b3d7a2SStefano Zampini       }
8249566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(sub_schurs->is_subs[i],&subset_size));
8259566063dSJacob Faibussowitsch       PetscCall(MatCreateSeqDense(PETSC_COMM_SELF,subset_size,subset_size,work,&S_Ej_expl));
8269566063dSJacob Faibussowitsch       PetscCall(PCBDDCComputeExplicitSchur(S_Ej,sub_schurs->is_symmetric,MAT_REUSE_MATRIX,&S_Ej_expl));
8279566063dSJacob Faibussowitsch       PetscCall(PetscObjectTypeCompare((PetscObject)S_Ej_expl,MATSEQDENSE,&Sdense));
8285a95e1ceSStefano Zampini       if (Sdense) {
8295a95e1ceSStefano Zampini         for (j=0;j<subset_size;j++) {
8305a95e1ceSStefano Zampini           dummy_idx[j]=local_size+j;
831b1b3d7a2SStefano Zampini         }
8329566063dSJacob Faibussowitsch         PetscCall(MatSetValues(sub_schurs->S_Ej_all,subset_size,dummy_idx,subset_size,dummy_idx,work,INSERT_VALUES));
8336c4ed002SBarry Smith       } else SETERRQ(PETSC_COMM_SELF,PETSC_ERR_SUP,"Not yet implemented for sparse matrices");
8349566063dSJacob Faibussowitsch       PetscCall(MatDestroy(&S_Ej));
8359566063dSJacob Faibussowitsch       PetscCall(MatDestroy(&S_Ej_expl));
8365a95e1ceSStefano Zampini       local_size += subset_size;
8375a95e1ceSStefano Zampini     }
8389566063dSJacob Faibussowitsch     PetscCall(PetscFree2(dummy_idx,work));
839b1b3d7a2SStefano Zampini     /* free */
8409566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&is_I));
8419566063dSJacob Faibussowitsch     PetscCall(MatDestroy(&AE_II));
8429566063dSJacob Faibussowitsch     PetscCall(PetscFree(all_local_idx_N));
843883469d8SStefano Zampini   } else {
8445cbda25cSStefano Zampini     Mat               A,cs_AIB_mat = NULL,benign_AIIm1_ones_mat = NULL;
8459d54b7f4SStefano Zampini     Vec               Dall = NULL;
846ca92afb2SStefano Zampini     IS                is_A_all,*is_p_r = NULL;
8477ebab0bbSStefano Zampini     MatType           Stype;
8485cbda25cSStefano Zampini     PetscScalar       *work,*S_data,*schur_factor,infty = PETSC_MAX_REAL;
84904c5b2e6SStefano Zampini     PetscScalar       *SEj_arr = NULL,*SEjinv_arr = NULL;
8501683a169SBarry Smith     const PetscScalar *rS_data;
85104c5b2e6SStefano Zampini     PetscInt          n,n_I,size_schur,size_active_schur,cum,cum2;
8523fc34f97SStefano Zampini     PetscBool         economic,solver_S,S_lower_triangular = PETSC_FALSE;
8533fc34f97SStefano Zampini     PetscBool         schur_has_vertices,factor_workaround;
85411955456SStefano Zampini     PetscBool         use_cholesky;
8557ebab0bbSStefano Zampini #if defined(PETSC_HAVE_VIENNACL) || defined(PETSC_HAVE_CUDA)
8567ebab0bbSStefano Zampini     PetscBool         oldpin;
8577ebab0bbSStefano Zampini #endif
858883469d8SStefano Zampini 
859683d3df6SStefano Zampini     /* get sizes */
86081ea8064SStefano Zampini     n_I = 0;
86181ea8064SStefano Zampini     if (is_I_layer) {
8629566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(is_I_layer,&n_I));
86381ea8064SStefano Zampini     }
864683d3df6SStefano Zampini     economic = PETSC_FALSE;
8659566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(sub_schurs->is_I,&cum));
866683d3df6SStefano Zampini     if (cum != n_I) economic = PETSC_TRUE;
8679566063dSJacob Faibussowitsch     PetscCall(MatGetLocalSize(sub_schurs->A,&n,NULL));
8689d54b7f4SStefano Zampini     size_active_schur = local_size;
8699d54b7f4SStefano Zampini 
870f17d2ae1SStefano Zampini     /* import scaling vector (wrong formulation if we have 3D edges) */
8719d54b7f4SStefano Zampini     if (scaling && compute_Stilda) {
8729d54b7f4SStefano Zampini       const PetscScalar *array;
8739d54b7f4SStefano Zampini       PetscScalar       *array2;
8749d54b7f4SStefano Zampini       const PetscInt    *idxs;
8759d54b7f4SStefano Zampini       PetscInt          i;
8769d54b7f4SStefano Zampini 
8779566063dSJacob Faibussowitsch       PetscCall(ISGetIndices(sub_schurs->is_Ej_all,&idxs));
8789566063dSJacob Faibussowitsch       PetscCall(VecCreateSeq(PETSC_COMM_SELF,size_active_schur,&Dall));
8799566063dSJacob Faibussowitsch       PetscCall(VecGetArrayRead(scaling,&array));
8809566063dSJacob Faibussowitsch       PetscCall(VecGetArray(Dall,&array2));
8819d54b7f4SStefano Zampini       for (i=0;i<size_active_schur;i++) array2[i] = array[idxs[i]];
8829566063dSJacob Faibussowitsch       PetscCall(VecRestoreArray(Dall,&array2));
8839566063dSJacob Faibussowitsch       PetscCall(VecRestoreArrayRead(scaling,&array));
8849566063dSJacob Faibussowitsch       PetscCall(ISRestoreIndices(sub_schurs->is_Ej_all,&idxs));
8859d54b7f4SStefano Zampini       deluxe = PETSC_FALSE;
8869d54b7f4SStefano Zampini     }
887d62866d3SStefano Zampini 
888683d3df6SStefano Zampini     /* size active schurs does not count any dirichlet or vertex dof on the interface */
8893fc34f97SStefano Zampini     factor_workaround = PETSC_FALSE;
8903fc34f97SStefano Zampini     schur_has_vertices = PETSC_FALSE;
891683d3df6SStefano Zampini     cum = n_I+size_active_schur;
892683d3df6SStefano Zampini     if (sub_schurs->is_dir) {
893683d3df6SStefano Zampini       const PetscInt* idxs;
894683d3df6SStefano Zampini       PetscInt        n_dir;
895683d3df6SStefano Zampini 
8969566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(sub_schurs->is_dir,&n_dir));
8979566063dSJacob Faibussowitsch       PetscCall(ISGetIndices(sub_schurs->is_dir,&idxs));
8989566063dSJacob Faibussowitsch       PetscCall(PetscArraycpy(all_local_idx_N+cum,idxs,n_dir));
8999566063dSJacob Faibussowitsch       PetscCall(ISRestoreIndices(sub_schurs->is_dir,&idxs));
900683d3df6SStefano Zampini       cum += n_dir;
9013fc34f97SStefano Zampini       factor_workaround = PETSC_TRUE;
902d62866d3SStefano Zampini     }
903683d3df6SStefano Zampini     /* include the primal vertices in the Schur complement */
904367aa537SStefano Zampini     if (exact_schur && sub_schurs->is_vertices && (compute_Stilda || benign_n)) {
905683d3df6SStefano Zampini       PetscInt n_v;
906683d3df6SStefano Zampini 
9079566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(sub_schurs->is_vertices,&n_v));
908683d3df6SStefano Zampini       if (n_v) {
909683d3df6SStefano Zampini         const PetscInt* idxs;
910683d3df6SStefano Zampini 
9119566063dSJacob Faibussowitsch         PetscCall(ISGetIndices(sub_schurs->is_vertices,&idxs));
9129566063dSJacob Faibussowitsch         PetscCall(PetscArraycpy(all_local_idx_N+cum,idxs,n_v));
9139566063dSJacob Faibussowitsch         PetscCall(ISRestoreIndices(sub_schurs->is_vertices,&idxs));
914683d3df6SStefano Zampini         cum += n_v;
915683d3df6SStefano Zampini         factor_workaround = PETSC_TRUE;
9163fc34f97SStefano Zampini         schur_has_vertices = PETSC_TRUE;
917683d3df6SStefano Zampini       }
918683d3df6SStefano Zampini     }
919683d3df6SStefano Zampini     size_schur = cum - n_I;
9209566063dSJacob Faibussowitsch     PetscCall(ISCreateGeneral(PETSC_COMM_SELF,cum,all_local_idx_N,PETSC_OWN_POINTER,&is_A_all));
9217ebab0bbSStefano Zampini #if defined(PETSC_HAVE_VIENNACL) || defined(PETSC_HAVE_CUDA)
922b470e4b4SRichard Tran Mills     oldpin = sub_schurs->A->boundtocpu;
9239566063dSJacob Faibussowitsch     PetscCall(MatBindToCPU(sub_schurs->A,PETSC_TRUE));
9247ebab0bbSStefano Zampini #endif
925683d3df6SStefano Zampini     if (cum == n) {
9269566063dSJacob Faibussowitsch       PetscCall(ISSetPermutation(is_A_all));
9279566063dSJacob Faibussowitsch       PetscCall(MatPermute(sub_schurs->A,is_A_all,is_A_all,&A));
928683d3df6SStefano Zampini     } else {
9299566063dSJacob Faibussowitsch       PetscCall(MatCreateSubMatrix(sub_schurs->A,is_A_all,is_A_all,MAT_INITIAL_MATRIX,&A));
930683d3df6SStefano Zampini     }
9317ebab0bbSStefano Zampini #if defined(PETSC_HAVE_VIENNACL) || defined(PETSC_HAVE_CUDA)
9329566063dSJacob Faibussowitsch     PetscCall(MatBindToCPU(sub_schurs->A,oldpin));
9337ebab0bbSStefano Zampini #endif
9349566063dSJacob Faibussowitsch     PetscCall(MatSetOptionsPrefix(A,sub_schurs->prefix));
9359566063dSJacob Faibussowitsch     PetscCall(MatAppendOptionsPrefix(A,"sub_schurs_"));
936ca92afb2SStefano Zampini 
937ca92afb2SStefano Zampini     /* if we actually change the basis for the pressures, LDL^T factors will use a lot of memory
9387ebab0bbSStefano Zampini        this is a workaround */
939ca92afb2SStefano Zampini     if (benign_n) {
9407ebab0bbSStefano Zampini       Vec                    v,benign_AIIm1_ones;
941ca92afb2SStefano Zampini       ISLocalToGlobalMapping N_to_reor;
942ca92afb2SStefano Zampini       IS                     is_p0,is_p0_p;
9435cbda25cSStefano Zampini       PetscScalar            *cs_AIB,*AIIm1_data;
9445cbda25cSStefano Zampini       PetscInt               sizeA;
945ca92afb2SStefano Zampini 
9469566063dSJacob Faibussowitsch       PetscCall(ISLocalToGlobalMappingCreateIS(is_A_all,&N_to_reor));
9479566063dSJacob Faibussowitsch       PetscCall(ISCreateGeneral(PETSC_COMM_SELF,benign_n,benign_p0_lidx,PETSC_COPY_VALUES,&is_p0));
9489566063dSJacob Faibussowitsch       PetscCall(ISGlobalToLocalMappingApplyIS(N_to_reor,IS_GTOLM_DROP,is_p0,&is_p0_p));
9499566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&is_p0));
9509566063dSJacob Faibussowitsch       PetscCall(MatCreateVecs(A,&v,&benign_AIIm1_ones));
9519566063dSJacob Faibussowitsch       PetscCall(VecGetSize(v,&sizeA));
9529566063dSJacob Faibussowitsch       PetscCall(MatCreateSeqDense(PETSC_COMM_SELF,sizeA,benign_n,NULL,&benign_AIIm1_ones_mat));
9539566063dSJacob Faibussowitsch       PetscCall(MatCreateSeqDense(PETSC_COMM_SELF,size_schur,benign_n,NULL,&cs_AIB_mat));
9549566063dSJacob Faibussowitsch       PetscCall(MatDenseGetArray(cs_AIB_mat,&cs_AIB));
9559566063dSJacob Faibussowitsch       PetscCall(MatDenseGetArray(benign_AIIm1_ones_mat,&AIIm1_data));
9569566063dSJacob Faibussowitsch       PetscCall(PetscMalloc1(benign_n,&is_p_r));
957ca92afb2SStefano Zampini       /* compute colsum of A_IB restricted to pressures */
958ca92afb2SStefano Zampini       for (i=0;i<benign_n;i++) {
9597ebab0bbSStefano Zampini         const PetscScalar *array;
960ca92afb2SStefano Zampini         const PetscInt    *idxs;
961ca92afb2SStefano Zampini         PetscInt          j,nz;
962ca92afb2SStefano Zampini 
9639566063dSJacob Faibussowitsch         PetscCall(ISGlobalToLocalMappingApplyIS(N_to_reor,IS_GTOLM_DROP,benign_zerodiag_subs[i],&is_p_r[i]));
9649566063dSJacob Faibussowitsch         PetscCall(ISGetLocalSize(is_p_r[i],&nz));
9659566063dSJacob Faibussowitsch         PetscCall(ISGetIndices(is_p_r[i],&idxs));
9665cbda25cSStefano Zampini         for (j=0;j<nz;j++) AIIm1_data[idxs[j]+sizeA*i] = 1.;
9679566063dSJacob Faibussowitsch         PetscCall(ISRestoreIndices(is_p_r[i],&idxs));
9689566063dSJacob Faibussowitsch         PetscCall(VecPlaceArray(benign_AIIm1_ones,AIIm1_data+sizeA*i));
9699566063dSJacob Faibussowitsch         PetscCall(MatMult(A,benign_AIIm1_ones,v));
9709566063dSJacob Faibussowitsch         PetscCall(VecResetArray(benign_AIIm1_ones));
9719566063dSJacob Faibussowitsch         PetscCall(VecGetArrayRead(v,&array));
97222db5ddcSStefano Zampini         for (j=0;j<size_schur;j++) {
97322db5ddcSStefano Zampini #if defined(PETSC_USE_COMPLEX)
97422db5ddcSStefano Zampini           cs_AIB[i*size_schur + j] = (PetscRealPart(array[j+n_I])/nz + PETSC_i*(PetscImaginaryPart(array[j+n_I])/nz));
97522db5ddcSStefano Zampini #else
97622db5ddcSStefano Zampini           cs_AIB[i*size_schur + j] = array[j+n_I]/nz;
97722db5ddcSStefano Zampini #endif
97822db5ddcSStefano Zampini         }
9799566063dSJacob Faibussowitsch         PetscCall(VecRestoreArrayRead(v,&array));
980ca92afb2SStefano Zampini       }
9819566063dSJacob Faibussowitsch       PetscCall(MatDenseRestoreArray(cs_AIB_mat,&cs_AIB));
9829566063dSJacob Faibussowitsch       PetscCall(MatDenseRestoreArray(benign_AIIm1_ones_mat,&AIIm1_data));
9839566063dSJacob Faibussowitsch       PetscCall(VecDestroy(&v));
9849566063dSJacob Faibussowitsch       PetscCall(VecDestroy(&benign_AIIm1_ones));
9859566063dSJacob Faibussowitsch       PetscCall(MatSetOption(A,MAT_KEEP_NONZERO_PATTERN,PETSC_FALSE));
9869566063dSJacob Faibussowitsch       PetscCall(MatSetOption(A,MAT_NEW_NONZERO_LOCATION_ERR,PETSC_FALSE));
9879566063dSJacob Faibussowitsch       PetscCall(MatSetOption(A,MAT_NEW_NONZERO_ALLOCATION_ERR,PETSC_FALSE));
9889566063dSJacob Faibussowitsch       PetscCall(MatZeroRowsColumnsIS(A,is_p0_p,1.0,NULL,NULL));
9899566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&is_p0_p));
9909566063dSJacob Faibussowitsch       PetscCall(ISLocalToGlobalMappingDestroy(&N_to_reor));
991ca92afb2SStefano Zampini     }
9929566063dSJacob Faibussowitsch     PetscCall(MatSetOption(A,MAT_SYMMETRIC,sub_schurs->is_symmetric));
9939566063dSJacob Faibussowitsch     PetscCall(MatSetOption(A,MAT_HERMITIAN,sub_schurs->is_hermitian));
9949566063dSJacob Faibussowitsch     PetscCall(MatSetOption(A,MAT_SPD,sub_schurs->is_posdef));
995883469d8SStefano Zampini 
99611955456SStefano Zampini     /* for complexes, symmetric and hermitian at the same time implies null imaginary part */
99711955456SStefano Zampini     use_cholesky = (PetscBool)((use_potr || use_sytr) && sub_schurs->is_hermitian && sub_schurs->is_symmetric);
99811955456SStefano Zampini 
999683d3df6SStefano Zampini     /* when using the benign subspace trick, the local Schur complements are SPD */
100035d0533cSStefano Zampini     /* MKL_PARDISO does not handle well the computation of a Schur complement from a symmetric indefinite factorization
100135d0533cSStefano Zampini        Use LU and adapt pivoting perturbation (still, solution is not as accurate as with using MUMPS) */
100235d0533cSStefano Zampini     if (benign_trick) {
100335d0533cSStefano Zampini       sub_schurs->is_posdef = PETSC_TRUE;
10049566063dSJacob Faibussowitsch       PetscCall(PetscStrcmp(sub_schurs->mat_solver_type,MATSOLVERMKL_PARDISO,&flg));
100535d0533cSStefano Zampini       if (flg) use_cholesky = PETSC_FALSE;
100635d0533cSStefano Zampini     }
1007d47842beSStefano Zampini 
1008f4f7d9d6SStefano Zampini     if (n_I) {
10090aa714b2SStefano Zampini       IS        is_schur;
10107ebab0bbSStefano Zampini       char      stype[64];
10114ba54290SStefano Zampini       PetscBool gpu = PETSC_FALSE;
10125a05ddb0SStefano Zampini 
101311955456SStefano Zampini       if (use_cholesky) {
10149566063dSJacob Faibussowitsch         PetscCall(MatGetFactor(A,sub_schurs->mat_solver_type,MAT_FACTOR_CHOLESKY,&F));
1015883469d8SStefano Zampini       } else {
10169566063dSJacob Faibussowitsch         PetscCall(MatGetFactor(A,sub_schurs->mat_solver_type,MAT_FACTOR_LU,&F));
1017883469d8SStefano Zampini       }
10189566063dSJacob Faibussowitsch       PetscCall(MatSetErrorIfFailure(A,PETSC_TRUE));
101935d0533cSStefano Zampini #if defined(PETSC_HAVE_MKL_PARDISO)
10209566063dSJacob Faibussowitsch       if (benign_trick) PetscCall(MatMkl_PardisoSetCntl(F,10,10));
102135d0533cSStefano Zampini #endif
1022883469d8SStefano Zampini       /* subsets ordered last */
10239566063dSJacob Faibussowitsch       PetscCall(ISCreateStride(PETSC_COMM_SELF,size_schur,n_I,1,&is_schur));
10249566063dSJacob Faibussowitsch       PetscCall(MatFactorSetSchurIS(F,is_schur));
10259566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&is_schur));
1026883469d8SStefano Zampini 
1027883469d8SStefano Zampini       /* factorization step */
102811955456SStefano Zampini       if (use_cholesky) {
10299566063dSJacob Faibussowitsch         PetscCall(MatCholeskyFactorSymbolic(F,A,NULL,NULL));
1030be83ff47SStefano Zampini #if defined(PETSC_HAVE_MUMPS) /* be sure that icntl 19 is not set by command line */
10319566063dSJacob Faibussowitsch         PetscCall(MatMumpsSetIcntl(F,19,2));
1032be83ff47SStefano Zampini #endif
10339566063dSJacob Faibussowitsch         PetscCall(MatCholeskyFactorNumeric(F,A,NULL));
1034a0b0af32SStefano Zampini         S_lower_triangular = PETSC_TRUE;
1035883469d8SStefano Zampini       } else {
10369566063dSJacob Faibussowitsch         PetscCall(MatLUFactorSymbolic(F,A,NULL,NULL,NULL));
1037be83ff47SStefano Zampini #if defined(PETSC_HAVE_MUMPS) /* be sure that icntl 19 is not set by command line */
10389566063dSJacob Faibussowitsch         PetscCall(MatMumpsSetIcntl(F,19,3));
1039be83ff47SStefano Zampini #endif
10409566063dSJacob Faibussowitsch         PetscCall(MatLUFactorNumeric(F,A,NULL));
1041883469d8SStefano Zampini       }
10429566063dSJacob Faibussowitsch       PetscCall(MatViewFromOptions(F,(PetscObject)A,"-mat_factor_view"));
1043883469d8SStefano Zampini 
10443b03f7bbSStefano Zampini       if (matl_dbg_viewer) {
104511955456SStefano Zampini         Mat S;
104611955456SStefano Zampini         IS  is;
104711955456SStefano Zampini 
10489566063dSJacob Faibussowitsch         PetscCall(PetscObjectSetName((PetscObject)A,"A"));
10499566063dSJacob Faibussowitsch         PetscCall(MatView(A,matl_dbg_viewer));
10509566063dSJacob Faibussowitsch         PetscCall(MatFactorCreateSchurComplement(F,&S,NULL));
10519566063dSJacob Faibussowitsch         PetscCall(PetscObjectSetName((PetscObject)S,"S"));
10529566063dSJacob Faibussowitsch         PetscCall(MatView(S,matl_dbg_viewer));
10539566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&S));
10549566063dSJacob Faibussowitsch         PetscCall(ISCreateStride(PETSC_COMM_SELF,n_I,0,1,&is));
10559566063dSJacob Faibussowitsch         PetscCall(PetscObjectSetName((PetscObject)is,"I"));
10569566063dSJacob Faibussowitsch         PetscCall(ISView(is,matl_dbg_viewer));
10579566063dSJacob Faibussowitsch         PetscCall(ISDestroy(&is));
10589566063dSJacob Faibussowitsch         PetscCall(ISCreateStride(PETSC_COMM_SELF,size_schur,n_I,1,&is));
10599566063dSJacob Faibussowitsch         PetscCall(PetscObjectSetName((PetscObject)is,"B"));
10609566063dSJacob Faibussowitsch         PetscCall(ISView(is,matl_dbg_viewer));
10619566063dSJacob Faibussowitsch         PetscCall(ISDestroy(&is));
10629566063dSJacob Faibussowitsch         PetscCall(PetscObjectSetName((PetscObject)is_A_all,"IA"));
10639566063dSJacob Faibussowitsch         PetscCall(ISView(is_A_all,matl_dbg_viewer));
106411955456SStefano Zampini       }
106511955456SStefano Zampini 
1066883469d8SStefano Zampini       /* get explicit Schur Complement computed during numeric factorization */
10679566063dSJacob Faibussowitsch       PetscCall(MatFactorGetSchurComplement(F,&S_all,NULL));
10689566063dSJacob Faibussowitsch       PetscCall(PetscStrncpy(stype,MATSEQDENSE,sizeof(stype)));
10694ba54290SStefano Zampini #if defined(PETSC_HAVE_CUDA)
10709566063dSJacob Faibussowitsch       PetscCall(PetscObjectTypeCompareAny((PetscObject)A,&gpu,MATSEQAIJVIENNACL,MATSEQAIJCUSPARSE,""));
10714ba54290SStefano Zampini #endif
10727ebab0bbSStefano Zampini       if (gpu) {
10739566063dSJacob Faibussowitsch         PetscCall(PetscStrncpy(stype,MATSEQDENSECUDA,sizeof(stype)));
10747ebab0bbSStefano Zampini       }
10759566063dSJacob Faibussowitsch       PetscCall(PetscOptionsGetString(NULL,sub_schurs->prefix,"-sub_schurs_schur_mat_type",stype,sizeof(stype),NULL));
10769566063dSJacob Faibussowitsch       PetscCall(MatConvert(S_all,stype,MAT_INPLACE_MATRIX,&S_all));
10779566063dSJacob Faibussowitsch       PetscCall(MatSetOption(S_all,MAT_SPD,sub_schurs->is_posdef));
10789566063dSJacob Faibussowitsch       PetscCall(MatSetOption(S_all,MAT_HERMITIAN,sub_schurs->is_hermitian));
10799566063dSJacob Faibussowitsch       PetscCall(MatGetType(S_all,&Stype));
1080b3cb21ddSStefano Zampini 
1081d62866d3SStefano Zampini       /* we can reuse the solvers if we are not using the economic version */
1082683d3df6SStefano Zampini       reuse_solvers = (PetscBool)(reuse_solvers && !economic);
1083683d3df6SStefano Zampini       factor_workaround = (PetscBool)(reuse_solvers && factor_workaround);
108403dfb2d7SStefano Zampini       if (!sub_schurs->is_posdef && factor_workaround && compute_Stilda && size_active_schur)
108503dfb2d7SStefano Zampini         reuse_solvers = factor_workaround = PETSC_FALSE;
108603dfb2d7SStefano Zampini 
1087df4d28bfSStefano Zampini       solver_S = PETSC_TRUE;
1088ca92afb2SStefano Zampini 
108972b8c272SStefano Zampini       /* update the Schur complement with the change of basis on the pressures */
1090ca92afb2SStefano Zampini       if (benign_n) {
10917ebab0bbSStefano Zampini         const PetscScalar *cs_AIB;
10927ebab0bbSStefano Zampini         PetscScalar       *S_data,*AIIm1_data;
10933b03f7bbSStefano Zampini         Mat               S2 = NULL,S3 = NULL; /* dbg */
10943b03f7bbSStefano Zampini         PetscScalar       *S2_data,*S3_data; /* dbg */
10957ebab0bbSStefano Zampini         Vec               v,benign_AIIm1_ones;
10965cbda25cSStefano Zampini         PetscInt          sizeA;
1097ca92afb2SStefano Zampini 
10989566063dSJacob Faibussowitsch         PetscCall(MatDenseGetArray(S_all,&S_data));
10999566063dSJacob Faibussowitsch         PetscCall(MatCreateVecs(A,&v,&benign_AIIm1_ones));
11009566063dSJacob Faibussowitsch         PetscCall(VecGetSize(v,&sizeA));
1101ca92afb2SStefano Zampini #if defined(PETSC_HAVE_MUMPS)
11029566063dSJacob Faibussowitsch         PetscCall(MatMumpsSetIcntl(F,26,0));
1103ca92afb2SStefano Zampini #endif
1104ca92afb2SStefano Zampini #if defined(PETSC_HAVE_MKL_PARDISO)
11059566063dSJacob Faibussowitsch         PetscCall(MatMkl_PardisoSetCntl(F,70,1));
1106ca92afb2SStefano Zampini #endif
11079566063dSJacob Faibussowitsch         PetscCall(MatDenseGetArrayRead(cs_AIB_mat,&cs_AIB));
11089566063dSJacob Faibussowitsch         PetscCall(MatDenseGetArray(benign_AIIm1_ones_mat,&AIIm1_data));
11093b03f7bbSStefano Zampini         if (matl_dbg_viewer) {
11109566063dSJacob Faibussowitsch           PetscCall(MatDuplicate(S_all,MAT_DO_NOT_COPY_VALUES,&S2));
11119566063dSJacob Faibussowitsch           PetscCall(MatDuplicate(S_all,MAT_DO_NOT_COPY_VALUES,&S3));
11129566063dSJacob Faibussowitsch           PetscCall(MatDenseGetArray(S2,&S2_data));
11139566063dSJacob Faibussowitsch           PetscCall(MatDenseGetArray(S3,&S3_data));
11143b03f7bbSStefano Zampini         }
1115ca92afb2SStefano Zampini         for (i=0;i<benign_n;i++) {
11163b03f7bbSStefano Zampini           PetscScalar    *array,sum = 0.,one = 1.,*sums;
1117ca92afb2SStefano Zampini           const PetscInt *idxs;
11183b03f7bbSStefano Zampini           PetscInt       k,j,nz;
111947484b83SStefano Zampini           PetscBLASInt   B_k,B_n;
1120ca92afb2SStefano Zampini 
11219566063dSJacob Faibussowitsch           PetscCall(PetscCalloc1(benign_n,&sums));
11229566063dSJacob Faibussowitsch           PetscCall(VecPlaceArray(benign_AIIm1_ones,AIIm1_data+sizeA*i));
11239566063dSJacob Faibussowitsch           PetscCall(VecCopy(benign_AIIm1_ones,v));
11249566063dSJacob Faibussowitsch           PetscCall(MatSolve(F,v,benign_AIIm1_ones));
11259566063dSJacob Faibussowitsch           PetscCall(MatMult(A,benign_AIIm1_ones,v));
11269566063dSJacob Faibussowitsch           PetscCall(VecResetArray(benign_AIIm1_ones));
11273b03f7bbSStefano Zampini           /* p0 dofs (eliminated) are excluded from the sums */
11283b03f7bbSStefano Zampini           for (k=0;k<benign_n;k++) {
11299566063dSJacob Faibussowitsch             PetscCall(ISGetLocalSize(is_p_r[k],&nz));
11309566063dSJacob Faibussowitsch             PetscCall(ISGetIndices(is_p_r[k],&idxs));
11313b03f7bbSStefano Zampini             for (j=0;j<nz-1;j++) sums[k] -= AIIm1_data[idxs[j]+sizeA*i];
11329566063dSJacob Faibussowitsch             PetscCall(ISRestoreIndices(is_p_r[k],&idxs));
11333b03f7bbSStefano Zampini           }
11349566063dSJacob Faibussowitsch           PetscCall(VecGetArrayRead(v,(const PetscScalar**)&array));
11353b03f7bbSStefano Zampini           if (matl_dbg_viewer) {
11363b03f7bbSStefano Zampini             Vec  vv;
11373b03f7bbSStefano Zampini             char name[16];
11383b03f7bbSStefano Zampini 
11399566063dSJacob Faibussowitsch             PetscCall(VecCreateSeqWithArray(PETSC_COMM_SELF,1,size_schur,array+n_I,&vv));
11409566063dSJacob Faibussowitsch             PetscCall(PetscSNPrintf(name,sizeof(name),"Pvs%D",i));
11419566063dSJacob Faibussowitsch             PetscCall(PetscObjectSetName((PetscObject)vv,name));
11429566063dSJacob Faibussowitsch             PetscCall(VecView(vv,matl_dbg_viewer));
11433b03f7bbSStefano Zampini           }
114447484b83SStefano Zampini           /* perform sparse rank updates on symmetric Schur (TODO: move outside of the loop?) */
114547484b83SStefano Zampini           /* cs_AIB already scaled by 1./nz */
114647484b83SStefano Zampini           B_k = 1;
11473b03f7bbSStefano Zampini           for (k=0;k<benign_n;k++) {
11483b03f7bbSStefano Zampini             sum  = sums[k];
11499566063dSJacob Faibussowitsch             PetscCall(PetscBLASIntCast(size_schur,&B_n));
11503b03f7bbSStefano Zampini 
11513b03f7bbSStefano Zampini             if (PetscAbsScalar(sum) == 0.0) continue;
11523b03f7bbSStefano Zampini             if (k == i) {
115347484b83SStefano Zampini               PetscStackCallBLAS("BLASsyrk",BLASsyrk_("L","N",&B_n,&B_k,&sum,cs_AIB+i*size_schur,&B_n,&one,S_data,&B_n));
11543b03f7bbSStefano Zampini               if (matl_dbg_viewer) {
11553b03f7bbSStefano Zampini                 PetscStackCallBLAS("BLASsyrk",BLASsyrk_("L","N",&B_n,&B_k,&sum,cs_AIB+i*size_schur,&B_n,&one,S3_data,&B_n));
11563b03f7bbSStefano Zampini               }
11573b03f7bbSStefano Zampini             } else { /* XXX Is it correct to use symmetric rank-2 update with half of the sum? */
11583b03f7bbSStefano Zampini               sum /= 2.0;
11593b03f7bbSStefano Zampini               PetscStackCallBLAS("BLASsyr2k",BLASsyr2k_("L","N",&B_n,&B_k,&sum,cs_AIB+k*size_schur,&B_n,cs_AIB+i*size_schur,&B_n,&one,S_data,&B_n));
11603b03f7bbSStefano Zampini               if (matl_dbg_viewer) {
11613b03f7bbSStefano Zampini                 PetscStackCallBLAS("BLASsyr2k",BLASsyr2k_("L","N",&B_n,&B_k,&sum,cs_AIB+k*size_schur,&B_n,cs_AIB+i*size_schur,&B_n,&one,S3_data,&B_n));
11623b03f7bbSStefano Zampini               }
11633b03f7bbSStefano Zampini             }
11643b03f7bbSStefano Zampini           }
11655cbda25cSStefano Zampini           sum  = 1.;
116647484b83SStefano Zampini           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));
11673b03f7bbSStefano Zampini           if (matl_dbg_viewer) {
11683b03f7bbSStefano Zampini             PetscStackCallBLAS("BLASsyr2k",BLASsyr2k_("L","N",&B_n,&B_k,&sum,array+n_I,&B_n,cs_AIB+i*size_schur,&B_n,&one,S2_data,&B_n));
11693b03f7bbSStefano Zampini           }
11709566063dSJacob Faibussowitsch           PetscCall(VecRestoreArrayRead(v,(const PetscScalar**)&array));
11715cbda25cSStefano Zampini           /* set p0 entry of AIIm1_ones to zero */
11729566063dSJacob Faibussowitsch           PetscCall(ISGetLocalSize(is_p_r[i],&nz));
11739566063dSJacob Faibussowitsch           PetscCall(ISGetIndices(is_p_r[i],&idxs));
1174282d6408SStefano Zampini           for (j=0;j<benign_n;j++) AIIm1_data[idxs[nz-1]+sizeA*j] = 0.;
11759566063dSJacob Faibussowitsch           PetscCall(ISRestoreIndices(is_p_r[i],&idxs));
11769566063dSJacob Faibussowitsch           PetscCall(PetscFree(sums));
11773b03f7bbSStefano Zampini         }
11789566063dSJacob Faibussowitsch         PetscCall(VecDestroy(&benign_AIIm1_ones));
11793b03f7bbSStefano Zampini         if (matl_dbg_viewer) {
11809566063dSJacob Faibussowitsch           PetscCall(MatDenseRestoreArray(S2,&S2_data));
11819566063dSJacob Faibussowitsch           PetscCall(MatDenseRestoreArray(S3,&S3_data));
1182ca92afb2SStefano Zampini         }
1183a7414863SStefano Zampini         if (!S_lower_triangular) { /* I need to expand the upper triangular data (column oriented) */
1184a7414863SStefano Zampini           PetscInt k,j;
1185a7414863SStefano Zampini           for (k=0;k<size_schur;k++) {
1186a7414863SStefano Zampini             for (j=k;j<size_schur;j++) {
1187a7414863SStefano Zampini               S_data[j*size_schur+k] = PetscConj(S_data[k*size_schur+j]);
1188a7414863SStefano Zampini             }
1189a7414863SStefano Zampini           }
1190a7414863SStefano Zampini         }
1191a7414863SStefano Zampini 
11925cbda25cSStefano Zampini         /* restore defaults */
11935cbda25cSStefano Zampini #if defined(PETSC_HAVE_MUMPS)
11949566063dSJacob Faibussowitsch         PetscCall(MatMumpsSetIcntl(F,26,-1));
11955cbda25cSStefano Zampini #endif
11965cbda25cSStefano Zampini #if defined(PETSC_HAVE_MKL_PARDISO)
11979566063dSJacob Faibussowitsch         PetscCall(MatMkl_PardisoSetCntl(F,70,0));
11985cbda25cSStefano Zampini #endif
11999566063dSJacob Faibussowitsch         PetscCall(MatDenseRestoreArrayRead(cs_AIB_mat,&cs_AIB));
12009566063dSJacob Faibussowitsch         PetscCall(MatDenseRestoreArray(benign_AIIm1_ones_mat,&AIIm1_data));
12019566063dSJacob Faibussowitsch         PetscCall(VecDestroy(&v));
12029566063dSJacob Faibussowitsch         PetscCall(MatDenseRestoreArray(S_all,&S_data));
12033b03f7bbSStefano Zampini         if (matl_dbg_viewer) {
12043b03f7bbSStefano Zampini           Mat S;
12053b03f7bbSStefano Zampini 
12069566063dSJacob Faibussowitsch           PetscCall(MatFactorRestoreSchurComplement(F,&S_all,MAT_FACTOR_SCHUR_UNFACTORED));
12079566063dSJacob Faibussowitsch           PetscCall(MatFactorCreateSchurComplement(F,&S,NULL));
12089566063dSJacob Faibussowitsch           PetscCall(PetscObjectSetName((PetscObject)S,"Sb"));
12099566063dSJacob Faibussowitsch           PetscCall(MatView(S,matl_dbg_viewer));
12109566063dSJacob Faibussowitsch           PetscCall(MatDestroy(&S));
12119566063dSJacob Faibussowitsch           PetscCall(PetscObjectSetName((PetscObject)S2,"S2P"));
12129566063dSJacob Faibussowitsch           PetscCall(MatView(S2,matl_dbg_viewer));
12139566063dSJacob Faibussowitsch           PetscCall(PetscObjectSetName((PetscObject)S3,"S3P"));
12149566063dSJacob Faibussowitsch           PetscCall(MatView(S3,matl_dbg_viewer));
12159566063dSJacob Faibussowitsch           PetscCall(PetscObjectSetName((PetscObject)cs_AIB_mat,"cs"));
12169566063dSJacob Faibussowitsch           PetscCall(MatView(cs_AIB_mat,matl_dbg_viewer));
12179566063dSJacob Faibussowitsch           PetscCall(MatFactorGetSchurComplement(F,&S_all,NULL));
12183b03f7bbSStefano Zampini         }
12199566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&S2));
12209566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&S3));
1221ca92afb2SStefano Zampini       }
1222a3df083aSStefano Zampini       if (!reuse_solvers) {
1223a3df083aSStefano Zampini         for (i=0;i<benign_n;i++) {
12249566063dSJacob Faibussowitsch           PetscCall(ISDestroy(&is_p_r[i]));
1225a3df083aSStefano Zampini         }
12269566063dSJacob Faibussowitsch         PetscCall(PetscFree(is_p_r));
12279566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&cs_AIB_mat));
12289566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&benign_AIIm1_ones_mat));
1229a3df083aSStefano Zampini       }
1230df4d28bfSStefano Zampini     } else { /* we can't use MatFactor when size_schur == size_of_the_problem */
12319566063dSJacob Faibussowitsch       PetscCall(MatConvert(A,MATSEQDENSE,MAT_INITIAL_MATRIX,&S_all));
12329566063dSJacob Faibussowitsch       PetscCall(MatGetType(S_all,&Stype));
1233683d3df6SStefano Zampini       reuse_solvers = PETSC_FALSE; /* TODO: why we can't reuse the solvers here? */
1234166598c1SStefano Zampini       factor_workaround = PETSC_FALSE;
1235df4d28bfSStefano Zampini       solver_S = PETSC_FALSE;
1236be83ff47SStefano Zampini     }
1237be83ff47SStefano Zampini 
1238be83ff47SStefano Zampini     if (reuse_solvers) {
1239a00504b5SStefano Zampini       Mat                A_II,Afake;
124053892102SStefano Zampini       Vec                vec1_B;
1241df4d28bfSStefano Zampini       PCBDDCReuseSolvers msolv_ctx;
12423462e049SStefano Zampini       PetscInt           n_R;
1243d5574798SStefano Zampini 
1244df4d28bfSStefano Zampini       if (sub_schurs->reuse_solver) {
12459566063dSJacob Faibussowitsch         PetscCall(PCBDDCReuseSolversReset(sub_schurs->reuse_solver));
1246e28d306cSStefano Zampini       } else {
12479566063dSJacob Faibussowitsch         PetscCall(PetscNew(&sub_schurs->reuse_solver));
1248d62866d3SStefano Zampini       }
1249df4d28bfSStefano Zampini       msolv_ctx = sub_schurs->reuse_solver;
12509566063dSJacob Faibussowitsch       PetscCall(MatSchurComplementGetSubMatrices(sub_schurs->S,&A_II,NULL,NULL,NULL,NULL));
12519566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)F));
1252d5574798SStefano Zampini       msolv_ctx->F = F;
12539566063dSJacob Faibussowitsch       PetscCall(MatCreateVecs(F,&msolv_ctx->sol,NULL));
1254683d3df6SStefano Zampini       /* currently PETSc has no support for MatSolve(F,x,x), so cheat and let rhs and sol share the same memory */
1255683d3df6SStefano Zampini       {
1256683d3df6SStefano Zampini         PetscScalar *array;
1257683d3df6SStefano Zampini         PetscInt    n;
1258683d3df6SStefano Zampini 
12599566063dSJacob Faibussowitsch         PetscCall(VecGetLocalSize(msolv_ctx->sol,&n));
12609566063dSJacob Faibussowitsch         PetscCall(VecGetArray(msolv_ctx->sol,&array));
12619566063dSJacob Faibussowitsch         PetscCall(VecCreateSeqWithArray(PetscObjectComm((PetscObject)msolv_ctx->sol),1,n,array,&msolv_ctx->rhs));
12629566063dSJacob Faibussowitsch         PetscCall(VecRestoreArray(msolv_ctx->sol,&array));
1263683d3df6SStefano Zampini       }
12643fc34f97SStefano Zampini       msolv_ctx->has_vertices = schur_has_vertices;
1265d62866d3SStefano Zampini 
1266d62866d3SStefano Zampini       /* interior solver */
12679566063dSJacob Faibussowitsch       PetscCall(PCCreate(PetscObjectComm((PetscObject)A_II),&msolv_ctx->interior_solver));
12689566063dSJacob Faibussowitsch       PetscCall(PCSetOperators(msolv_ctx->interior_solver,A_II,A_II));
12699566063dSJacob Faibussowitsch       PetscCall(PCSetType(msolv_ctx->interior_solver,PCSHELL));
12709566063dSJacob Faibussowitsch       PetscCall(PCShellSetName(msolv_ctx->interior_solver,"Interior solver (w/o Schur factorization)"));
12719566063dSJacob Faibussowitsch       PetscCall(PCShellSetContext(msolv_ctx->interior_solver,msolv_ctx));
12729566063dSJacob Faibussowitsch       PetscCall(PCShellSetView(msolv_ctx->interior_solver,PCBDDCReuseSolvers_View));
12739566063dSJacob Faibussowitsch       PetscCall(PCShellSetApply(msolv_ctx->interior_solver,PCBDDCReuseSolvers_Interior));
12749566063dSJacob Faibussowitsch       PetscCall(PCShellSetApplyTranspose(msolv_ctx->interior_solver,PCBDDCReuseSolvers_InteriorTranspose));
1275d62866d3SStefano Zampini 
1276d62866d3SStefano Zampini       /* correction solver */
12779566063dSJacob Faibussowitsch       PetscCall(PCCreate(PetscObjectComm((PetscObject)A_II),&msolv_ctx->correction_solver));
12789566063dSJacob Faibussowitsch       PetscCall(PCSetType(msolv_ctx->correction_solver,PCSHELL));
12799566063dSJacob Faibussowitsch       PetscCall(PCShellSetName(msolv_ctx->correction_solver,"Correction solver (with Schur factorization)"));
12809566063dSJacob Faibussowitsch       PetscCall(PCShellSetContext(msolv_ctx->correction_solver,msolv_ctx));
12819566063dSJacob Faibussowitsch       PetscCall(PCShellSetView(msolv_ctx->interior_solver,PCBDDCReuseSolvers_View));
12829566063dSJacob Faibussowitsch       PetscCall(PCShellSetApply(msolv_ctx->correction_solver,PCBDDCReuseSolvers_Correction));
12839566063dSJacob Faibussowitsch       PetscCall(PCShellSetApplyTranspose(msolv_ctx->correction_solver,PCBDDCReuseSolvers_CorrectionTranspose));
128453892102SStefano Zampini 
128553892102SStefano Zampini       /* scatter and vecs for Schur complement solver */
12869566063dSJacob Faibussowitsch       PetscCall(MatCreateVecs(S_all,&msolv_ctx->sol_B,&msolv_ctx->rhs_B));
12879566063dSJacob Faibussowitsch       PetscCall(MatCreateVecs(sub_schurs->S,&vec1_B,NULL));
12883fc34f97SStefano Zampini       if (!schur_has_vertices) {
12899566063dSJacob Faibussowitsch         PetscCall(ISGlobalToLocalMappingApplyIS(sub_schurs->BtoNmap,IS_GTOLM_DROP,is_A_all,&msolv_ctx->is_B));
12909566063dSJacob Faibussowitsch         PetscCall(VecScatterCreate(vec1_B,msolv_ctx->is_B,msolv_ctx->sol_B,NULL,&msolv_ctx->correction_scatter_B));
12919566063dSJacob Faibussowitsch         PetscCall(PetscObjectReference((PetscObject)is_A_all));
129253892102SStefano Zampini         msolv_ctx->is_R = is_A_all;
1293683d3df6SStefano Zampini       } else {
1294683d3df6SStefano Zampini         IS              is_B_all;
1295683d3df6SStefano Zampini         const PetscInt* idxs;
1296683d3df6SStefano Zampini         PetscInt        dual,n_v,n;
1297683d3df6SStefano Zampini 
12989566063dSJacob Faibussowitsch         PetscCall(ISGetLocalSize(sub_schurs->is_vertices,&n_v));
1299683d3df6SStefano Zampini         dual = size_schur - n_v;
13009566063dSJacob Faibussowitsch         PetscCall(ISGetLocalSize(is_A_all,&n));
13019566063dSJacob Faibussowitsch         PetscCall(ISGetIndices(is_A_all,&idxs));
13029566063dSJacob Faibussowitsch         PetscCall(ISCreateGeneral(PetscObjectComm((PetscObject)is_A_all),dual,idxs+n_I,PETSC_COPY_VALUES,&is_B_all));
13039566063dSJacob Faibussowitsch         PetscCall(ISGlobalToLocalMappingApplyIS(sub_schurs->BtoNmap,IS_GTOLM_DROP,is_B_all,&msolv_ctx->is_B));
13049566063dSJacob Faibussowitsch         PetscCall(ISDestroy(&is_B_all));
13059566063dSJacob Faibussowitsch         PetscCall(ISCreateStride(PetscObjectComm((PetscObject)is_A_all),dual,0,1,&is_B_all));
13069566063dSJacob Faibussowitsch         PetscCall(VecScatterCreate(vec1_B,msolv_ctx->is_B,msolv_ctx->sol_B,is_B_all,&msolv_ctx->correction_scatter_B));
13079566063dSJacob Faibussowitsch         PetscCall(ISDestroy(&is_B_all));
13089566063dSJacob Faibussowitsch         PetscCall(ISCreateGeneral(PetscObjectComm((PetscObject)is_A_all),n-n_v,idxs,PETSC_COPY_VALUES,&msolv_ctx->is_R));
13099566063dSJacob Faibussowitsch         PetscCall(ISRestoreIndices(is_A_all,&idxs));
1310683d3df6SStefano Zampini       }
13119566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(msolv_ctx->is_R,&n_R));
13129566063dSJacob Faibussowitsch       PetscCall(MatCreateSeqAIJ(PETSC_COMM_SELF,n_R,n_R,0,NULL,&Afake));
13139566063dSJacob Faibussowitsch       PetscCall(MatAssemblyBegin(Afake,MAT_FINAL_ASSEMBLY));
13149566063dSJacob Faibussowitsch       PetscCall(MatAssemblyEnd(Afake,MAT_FINAL_ASSEMBLY));
13159566063dSJacob Faibussowitsch       PetscCall(PCSetOperators(msolv_ctx->correction_solver,Afake,Afake));
13169566063dSJacob Faibussowitsch       PetscCall(MatDestroy(&Afake));
13179566063dSJacob Faibussowitsch       PetscCall(VecDestroy(&vec1_B));
1318ca92afb2SStefano Zampini 
1319ca92afb2SStefano Zampini       /* communicate benign info to solver context */
1320ca92afb2SStefano Zampini       if (benign_n) {
13215cbda25cSStefano Zampini         PetscScalar *array;
13225cbda25cSStefano Zampini 
1323ca92afb2SStefano Zampini         msolv_ctx->benign_n = benign_n;
1324ca92afb2SStefano Zampini         msolv_ctx->benign_zerodiag_subs = is_p_r;
13259566063dSJacob Faibussowitsch         PetscCall(PetscMalloc1(benign_n,&msolv_ctx->benign_save_vals));
13265cbda25cSStefano Zampini         msolv_ctx->benign_csAIB = cs_AIB_mat;
13279566063dSJacob Faibussowitsch         PetscCall(MatCreateVecs(cs_AIB_mat,&msolv_ctx->benign_corr_work,NULL));
13289566063dSJacob Faibussowitsch         PetscCall(VecGetArray(msolv_ctx->benign_corr_work,&array));
13299566063dSJacob Faibussowitsch         PetscCall(VecCreateSeqWithArray(PETSC_COMM_SELF,1,size_schur,array,&msolv_ctx->benign_dummy_schur_vec));
13309566063dSJacob Faibussowitsch         PetscCall(VecRestoreArray(msolv_ctx->benign_corr_work,&array));
13315cbda25cSStefano Zampini         msolv_ctx->benign_AIIm1ones = benign_AIIm1_ones_mat;
1332ca92afb2SStefano Zampini       }
1333ada6e2d7SStefano Zampini     } else {
1334ada6e2d7SStefano Zampini       if (sub_schurs->reuse_solver) {
13359566063dSJacob Faibussowitsch         PetscCall(PCBDDCReuseSolversReset(sub_schurs->reuse_solver));
1336ada6e2d7SStefano Zampini       }
13379566063dSJacob Faibussowitsch       PetscCall(PetscFree(sub_schurs->reuse_solver));
1338d5574798SStefano Zampini     }
13399566063dSJacob Faibussowitsch     PetscCall(MatDestroy(&A));
13409566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&is_A_all));
13415db18549SStefano Zampini 
1342be83ff47SStefano Zampini     /* Work arrays */
13439566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1(max_subset_size*max_subset_size,&work));
1344d2627357SStefano Zampini 
1345be83ff47SStefano Zampini     /* S_Ej_all */
1346be83ff47SStefano Zampini     cum = cum2 = 0;
13479566063dSJacob Faibussowitsch     PetscCall(MatDenseGetArrayRead(S_all,&rS_data));
13489566063dSJacob Faibussowitsch     PetscCall(MatSeqAIJGetArray(sub_schurs->S_Ej_all,&SEj_arr));
134904c5b2e6SStefano Zampini     if (compute_Stilda) {
13509566063dSJacob Faibussowitsch       PetscCall(MatSeqAIJGetArray(sub_schurs->sum_S_Ej_inv_all,&SEjinv_arr));
135104c5b2e6SStefano Zampini     }
135265d8bf0aSStefano Zampini     for (i=0;i<sub_schurs->n_subs;i++) {
135365d8bf0aSStefano Zampini       PetscInt j;
135465d8bf0aSStefano Zampini 
13555a95e1ceSStefano Zampini       /* get S_E */
13569566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(sub_schurs->is_subs[i],&subset_size));
1357683d3df6SStefano Zampini       if (S_lower_triangular) { /* I need to expand the upper triangular data (column oriented) */
1358be83ff47SStefano Zampini         PetscInt k;
1359be83ff47SStefano Zampini         for (k=0;k<subset_size;k++) {
1360be83ff47SStefano Zampini           for (j=k;j<subset_size;j++) {
13611683a169SBarry Smith             work[k*subset_size+j] = rS_data[cum2+k*size_schur+j];
13621683a169SBarry Smith             work[j*subset_size+k] = PetscConj(rS_data[cum2+k*size_schur+j]);
1363be83ff47SStefano Zampini           }
1364be83ff47SStefano Zampini         }
136506a4e24aSStefano Zampini       } else { /* just copy to workspace */
1366be83ff47SStefano Zampini         PetscInt k;
1367be83ff47SStefano Zampini         for (k=0;k<subset_size;k++) {
1368be83ff47SStefano Zampini           for (j=0;j<subset_size;j++) {
13691683a169SBarry Smith             work[k*subset_size+j] = rS_data[cum2+k*size_schur+j];
1370be83ff47SStefano Zampini           }
1371be83ff47SStefano Zampini         }
13729087bf02SStefano Zampini       }
13735a95e1ceSStefano Zampini       /* insert S_E values */
1374b7ab4a40SStefano Zampini       if (sub_schurs->change) {
13758760537fSStefano Zampini         Mat change_sub,SEj,T;
137672b8c272SStefano Zampini 
137772b8c272SStefano Zampini         /* change basis */
13789566063dSJacob Faibussowitsch         PetscCall(KSPGetOperators(sub_schurs->change[i],&change_sub,NULL));
13799566063dSJacob Faibussowitsch         PetscCall(MatCreateSeqDense(PETSC_COMM_SELF,subset_size,subset_size,work,&SEj));
13808760537fSStefano Zampini         if (!sub_schurs->change_with_qr) { /* currently there's no support for PtAP with P SeqAIJ */
13818760537fSStefano Zampini           Mat T2;
13829566063dSJacob Faibussowitsch           PetscCall(MatTransposeMatMult(change_sub,SEj,MAT_INITIAL_MATRIX,1.0,&T2));
13839566063dSJacob Faibussowitsch           PetscCall(MatMatMult(T2,change_sub,MAT_INITIAL_MATRIX,1.0,&T));
13849566063dSJacob Faibussowitsch           PetscCall(MatConvert(T,MATSEQDENSE,MAT_INPLACE_MATRIX,&T));
13859566063dSJacob Faibussowitsch           PetscCall(MatDestroy(&T2));
13868760537fSStefano Zampini         } else {
13879566063dSJacob Faibussowitsch           PetscCall(MatPtAP(SEj,change_sub,MAT_INITIAL_MATRIX,1.0,&T));
138872b8c272SStefano Zampini         }
13899566063dSJacob Faibussowitsch         PetscCall(MatCopy(T,SEj,SAME_NONZERO_PATTERN));
13909566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&T));
13919566063dSJacob Faibussowitsch         PetscCall(MatZeroRowsColumnsIS(SEj,sub_schurs->change_primal_sub[i],1.0,NULL,NULL));
13929566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&SEj));
139372b8c272SStefano Zampini       }
13949d54b7f4SStefano Zampini       if (deluxe) {
13959566063dSJacob Faibussowitsch         PetscCall(PetscArraycpy(SEj_arr,work,subset_size*subset_size));
1396683d3df6SStefano Zampini         /* if adaptivity is requested, invert S_E blocks */
1397862806e4SStefano Zampini         if (compute_Stilda) {
13987ebab0bbSStefano Zampini           Mat               M;
13997ebab0bbSStefano Zampini           const PetscScalar *vals;
14007ebab0bbSStefano Zampini           PetscBool         isdense,isdensecuda;
1401f4f7d9d6SStefano Zampini 
14029566063dSJacob Faibussowitsch           PetscCall(MatCreateSeqDense(PETSC_COMM_SELF,subset_size,subset_size,work,&M));
14039566063dSJacob Faibussowitsch           PetscCall(MatSetOption(M,MAT_SPD,sub_schurs->is_posdef));
14049566063dSJacob Faibussowitsch           PetscCall(MatSetOption(M,MAT_HERMITIAN,sub_schurs->is_hermitian));
14057ebab0bbSStefano Zampini           if (!PetscBTLookup(sub_schurs->is_edge,i)) {
14069566063dSJacob Faibussowitsch             PetscCall(MatSetType(M,Stype));
14076c3e6151SStefano Zampini           }
14089566063dSJacob Faibussowitsch           PetscCall(PetscObjectTypeCompare((PetscObject)M,MATSEQDENSE,&isdense));
14099566063dSJacob Faibussowitsch           PetscCall(PetscObjectTypeCompare((PetscObject)M,MATSEQDENSECUDA,&isdensecuda));
14107ebab0bbSStefano Zampini           if (use_cholesky) {
14119566063dSJacob Faibussowitsch             PetscCall(MatCholeskyFactor(M,NULL,NULL));
1412d6462365SStefano Zampini           } else {
14139566063dSJacob Faibussowitsch             PetscCall(MatLUFactor(M,NULL,NULL,NULL));
14142972d61bSStefano Zampini           }
14157ebab0bbSStefano Zampini           if (isdense) {
14169566063dSJacob Faibussowitsch             PetscCall(MatSeqDenseInvertFactors_Private(M));
14177ebab0bbSStefano Zampini #if defined(PETSC_HAVE_CUDA)
14187ebab0bbSStefano Zampini           } else if (isdensecuda) {
14199566063dSJacob Faibussowitsch             PetscCall(MatSeqDenseCUDAInvertFactors_Private(M));
14207ebab0bbSStefano Zampini #endif
142198921bdaSJacob Faibussowitsch           } else SETERRQ(PetscObjectComm((PetscObject)M),PETSC_ERR_SUP,"Not implemented for type %s",Stype);
14229566063dSJacob Faibussowitsch           PetscCall(MatDenseGetArrayRead(M,&vals));
14239566063dSJacob Faibussowitsch           PetscCall(PetscArraycpy(SEjinv_arr,vals,subset_size*subset_size));
14249566063dSJacob Faibussowitsch           PetscCall(MatDenseRestoreArrayRead(M,&vals));
14259566063dSJacob Faibussowitsch           PetscCall(MatDestroy(&M));
14269087bf02SStefano Zampini         }
14279d54b7f4SStefano Zampini       } else if (compute_Stilda) { /* not using deluxe */
14289d54b7f4SStefano Zampini         Mat         SEj;
14299d54b7f4SStefano Zampini         Vec         D;
14309d54b7f4SStefano Zampini         PetscScalar *array;
14319d54b7f4SStefano Zampini 
14329566063dSJacob Faibussowitsch         PetscCall(MatCreateSeqDense(PETSC_COMM_SELF,subset_size,subset_size,work,&SEj));
14339566063dSJacob Faibussowitsch         PetscCall(VecGetArray(Dall,&array));
14349566063dSJacob Faibussowitsch         PetscCall(VecCreateSeqWithArray(PETSC_COMM_SELF,1,subset_size,array+cum,&D));
14359566063dSJacob Faibussowitsch         PetscCall(VecRestoreArray(Dall,&array));
14369566063dSJacob Faibussowitsch         PetscCall(VecShift(D,-1.));
14379566063dSJacob Faibussowitsch         PetscCall(MatDiagonalScale(SEj,D,D));
14389566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&SEj));
14399566063dSJacob Faibussowitsch         PetscCall(VecDestroy(&D));
14409566063dSJacob Faibussowitsch         PetscCall(PetscArraycpy(SEj_arr,work,subset_size*subset_size));
14419d54b7f4SStefano Zampini       }
1442be83ff47SStefano Zampini       cum += subset_size;
1443be83ff47SStefano Zampini       cum2 += subset_size*(size_schur + 1);
144404c5b2e6SStefano Zampini       SEj_arr += subset_size*subset_size;
144504c5b2e6SStefano Zampini       if (SEjinv_arr) SEjinv_arr += subset_size*subset_size;
1446be83ff47SStefano Zampini     }
14479566063dSJacob Faibussowitsch     PetscCall(MatDenseRestoreArrayRead(S_all,&rS_data));
14489566063dSJacob Faibussowitsch     PetscCall(MatSeqAIJRestoreArray(sub_schurs->S_Ej_all,&SEj_arr));
144904c5b2e6SStefano Zampini     if (compute_Stilda) {
14509566063dSJacob Faibussowitsch       PetscCall(MatSeqAIJRestoreArray(sub_schurs->sum_S_Ej_inv_all,&SEjinv_arr));
145104c5b2e6SStefano Zampini     }
1452df4d28bfSStefano Zampini     if (solver_S) {
14539566063dSJacob Faibussowitsch       PetscCall(MatFactorRestoreSchurComplement(F,&S_all,MAT_FACTOR_SCHUR_UNFACTORED));
14544a6c6b0dSStefano Zampini     }
1455683d3df6SStefano Zampini 
14567ebab0bbSStefano Zampini     /* may prevent from unneeded copies, since MUMPS or MKL_Pardiso always use CPU memory
14577ebab0bbSStefano Zampini        however, preliminary tests indicate using GPUs is still faster in the solve phase */
14587ebab0bbSStefano Zampini #if defined(PETSC_HAVE_VIENNACL) || defined(PETSC_HAVE_CUDA)
14597ebab0bbSStefano Zampini     if (reuse_solvers) {
14607ebab0bbSStefano Zampini       Mat                  St;
14617ebab0bbSStefano Zampini       MatFactorSchurStatus st;
14627ebab0bbSStefano Zampini 
146335d0533cSStefano Zampini       flg  = PETSC_FALSE;
14649566063dSJacob Faibussowitsch       PetscCall(PetscOptionsGetBool(NULL,sub_schurs->prefix,"-sub_schurs_schur_pin_to_cpu",&flg,NULL));
14659566063dSJacob Faibussowitsch       PetscCall(MatFactorGetSchurComplement(F,&St,&st));
14669566063dSJacob Faibussowitsch       PetscCall(MatBindToCPU(St,flg));
14679566063dSJacob Faibussowitsch       PetscCall(MatFactorRestoreSchurComplement(F,&St,st));
14687ebab0bbSStefano Zampini     }
14697ebab0bbSStefano Zampini #endif
14707ebab0bbSStefano Zampini 
1471683d3df6SStefano Zampini     schur_factor = NULL;
147245951f25SStefano Zampini     if (compute_Stilda && size_active_schur) {
1473683d3df6SStefano Zampini 
14749566063dSJacob Faibussowitsch       PetscCall(MatSeqAIJGetArray(sub_schurs->sum_S_Ej_tilda_all,&SEjinv_arr));
14759d54b7f4SStefano Zampini       if (sub_schurs->n_subs == 1 && size_schur == size_active_schur && deluxe) { /* we already computed the inverse */
14769566063dSJacob Faibussowitsch         PetscCall(PetscArraycpy(SEjinv_arr,work,size_schur*size_schur));
14774a6c6b0dSStefano Zampini       } else {
1478683d3df6SStefano Zampini         Mat S_all_inv=NULL;
14797ebab0bbSStefano Zampini 
14803fc34f97SStefano Zampini         if (solver_S) {
1481683d3df6SStefano Zampini           /* for adaptive selection we need S^-1; for solver reusage we need S_\Delta\Delta^-1.
1482683d3df6SStefano Zampini              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 */
14833fc34f97SStefano Zampini           if (factor_workaround) {/* invert without calling MatFactorInvertSchurComplement, since we are hacking */
1484683d3df6SStefano Zampini             PetscScalar *data;
1485683d3df6SStefano Zampini             PetscInt     nd = 0;
14866dba178dSStefano Zampini 
1487f4f7d9d6SStefano Zampini             if (!use_potr) {
1488683d3df6SStefano Zampini               SETERRQ(PETSC_COMM_SELF,PETSC_ERR_SUP,"Factor update not yet implemented for non SPD matrices");
1489683d3df6SStefano Zampini             }
14909566063dSJacob Faibussowitsch             PetscCall(MatFactorGetSchurComplement(F,&S_all_inv,NULL));
14919566063dSJacob Faibussowitsch             PetscCall(MatDenseGetArray(S_all_inv,&data));
1492683d3df6SStefano Zampini             if (sub_schurs->is_dir) { /* dirichlet dofs could have different scalings */
14939566063dSJacob Faibussowitsch               PetscCall(ISGetLocalSize(sub_schurs->is_dir,&nd));
1494683d3df6SStefano Zampini             }
14953fc34f97SStefano Zampini 
14963fc34f97SStefano Zampini             /* factor and invert activedofs and vertices (dirichlet dofs does not contribute) */
14973fc34f97SStefano Zampini             if (schur_has_vertices) {
14983fc34f97SStefano Zampini               Mat          M;
14993fc34f97SStefano Zampini               PetscScalar *tdata;
15003fc34f97SStefano Zampini               PetscInt     nv = 0, news;
15013fc34f97SStefano Zampini 
15029566063dSJacob Faibussowitsch               PetscCall(ISGetLocalSize(sub_schurs->is_vertices,&nv));
15033fc34f97SStefano Zampini               news = size_active_schur + nv;
15049566063dSJacob Faibussowitsch               PetscCall(PetscCalloc1(news*news,&tdata));
1505683d3df6SStefano Zampini               for (i=0;i<size_active_schur;i++) {
15069566063dSJacob Faibussowitsch                 PetscCall(PetscArraycpy(tdata+i*(news+1),data+i*(size_schur+1),size_active_schur-i));
15079566063dSJacob Faibussowitsch                 PetscCall(PetscArraycpy(tdata+i*(news+1)+size_active_schur-i,data+i*size_schur+size_active_schur+nd,nv));
15083fc34f97SStefano Zampini               }
15093fc34f97SStefano Zampini               for (i=0;i<nv;i++) {
15103fc34f97SStefano Zampini                 PetscInt k = i+size_active_schur;
15119566063dSJacob Faibussowitsch                 PetscCall(PetscArraycpy(tdata+k*(news+1),data+(k+nd)*(size_schur+1),nv-i));
15123fc34f97SStefano Zampini               }
15133fc34f97SStefano Zampini 
15149566063dSJacob Faibussowitsch               PetscCall(MatCreateSeqDense(PETSC_COMM_SELF,news,news,tdata,&M));
15159566063dSJacob Faibussowitsch               PetscCall(MatSetOption(M,MAT_SPD,PETSC_TRUE));
15169566063dSJacob Faibussowitsch               PetscCall(MatCholeskyFactor(M,NULL,NULL));
15173fc34f97SStefano Zampini               /* save the factors */
15183fc34f97SStefano Zampini               cum = 0;
15199566063dSJacob Faibussowitsch               PetscCall(PetscMalloc1((size_active_schur*(size_active_schur +1))/2+nd,&schur_factor));
15203fc34f97SStefano Zampini               for (i=0;i<size_active_schur;i++) {
15219566063dSJacob Faibussowitsch                 PetscCall(PetscArraycpy(schur_factor+cum,tdata+i*(news+1),size_active_schur-i));
1522683d3df6SStefano Zampini                 cum += size_active_schur - i;
1523683d3df6SStefano Zampini               }
15243fc34f97SStefano Zampini               for (i=0;i<nd;i++) schur_factor[cum+i] = PetscSqrtReal(PetscRealPart(data[(i+size_active_schur)*(size_schur+1)]));
15259566063dSJacob Faibussowitsch               PetscCall(MatSeqDenseInvertFactors_Private(M));
15263fc34f97SStefano Zampini               /* move back just the active dofs to the Schur complement */
15273fc34f97SStefano Zampini               for (i=0;i<size_active_schur;i++) {
15289566063dSJacob Faibussowitsch                 PetscCall(PetscArraycpy(data+i*size_schur,tdata+i*news,size_active_schur));
15293fc34f97SStefano Zampini               }
15309566063dSJacob Faibussowitsch               PetscCall(PetscFree(tdata));
15319566063dSJacob Faibussowitsch               PetscCall(MatDestroy(&M));
15323fc34f97SStefano Zampini             } else { /* we can factorize and invert just the activedofs */
15333fc34f97SStefano Zampini               Mat         M;
15345002105bSStefano Zampini               PetscScalar *aux;
15353fc34f97SStefano Zampini 
15369566063dSJacob Faibussowitsch               PetscCall(PetscMalloc1(nd,&aux));
15375002105bSStefano Zampini               for (i=0;i<nd;i++) aux[i] = 1.0/data[(i+size_active_schur)*(size_schur+1)];
15389566063dSJacob Faibussowitsch               PetscCall(MatCreateSeqDense(PETSC_COMM_SELF,size_active_schur,size_active_schur,data,&M));
15399566063dSJacob Faibussowitsch               PetscCall(MatDenseSetLDA(M,size_schur));
15409566063dSJacob Faibussowitsch               PetscCall(MatSetOption(M,MAT_SPD,PETSC_TRUE));
15419566063dSJacob Faibussowitsch               PetscCall(MatCholeskyFactor(M,NULL,NULL));
15429566063dSJacob Faibussowitsch               PetscCall(MatSeqDenseInvertFactors_Private(M));
15439566063dSJacob Faibussowitsch               PetscCall(MatDestroy(&M));
15449566063dSJacob Faibussowitsch               PetscCall(MatCreateSeqDense(PETSC_COMM_SELF,size_schur,nd,data+size_active_schur*size_schur,&M));
15459566063dSJacob Faibussowitsch               PetscCall(MatZeroEntries(M));
15469566063dSJacob Faibussowitsch               PetscCall(MatDestroy(&M));
15479566063dSJacob Faibussowitsch               PetscCall(MatCreateSeqDense(PETSC_COMM_SELF,nd,size_schur,data+size_active_schur,&M));
15489566063dSJacob Faibussowitsch               PetscCall(MatDenseSetLDA(M,size_schur));
15499566063dSJacob Faibussowitsch               PetscCall(MatZeroEntries(M));
15509566063dSJacob Faibussowitsch               PetscCall(MatDestroy(&M));
15515002105bSStefano Zampini               for (i=0;i<nd;i++) data[(i+size_active_schur)*(size_schur+1)] = aux[i];
15529566063dSJacob Faibussowitsch               PetscCall(PetscFree(aux));
15533fc34f97SStefano Zampini             }
15549566063dSJacob Faibussowitsch             PetscCall(MatDenseRestoreArray(S_all_inv,&data));
15553fc34f97SStefano Zampini           } else { /* use MatFactor calls to invert S */
15569566063dSJacob Faibussowitsch             PetscCall(MatFactorInvertSchurComplement(F));
15579566063dSJacob Faibussowitsch             PetscCall(MatFactorGetSchurComplement(F,&S_all_inv,NULL));
1558683d3df6SStefano Zampini           }
1559df4d28bfSStefano Zampini         } else { /* we need to invert explicitly since we are not using MatFactor for S */
15609566063dSJacob Faibussowitsch           PetscCall(PetscObjectReference((PetscObject)S_all));
1561683d3df6SStefano Zampini           S_all_inv = S_all;
15629566063dSJacob Faibussowitsch           PetscCall(MatDenseGetArray(S_all_inv,&S_data));
15639566063dSJacob Faibussowitsch           PetscCall(PetscBLASIntCast(size_schur,&B_N));
15649566063dSJacob Faibussowitsch           PetscCall(PetscFPTrapPush(PETSC_FP_TRAP_OFF));
1565f4f7d9d6SStefano Zampini           if (use_potr) {
1566be83ff47SStefano Zampini             PetscStackCallBLAS("LAPACKpotrf",LAPACKpotrf_("L",&B_N,S_data,&B_N,&B_ierr));
156728b400f6SJacob Faibussowitsch             PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in POTRF Lapack routine %d",(int)B_ierr);
1568be83ff47SStefano Zampini             PetscStackCallBLAS("LAPACKpotri",LAPACKpotri_("L",&B_N,S_data,&B_N,&B_ierr));
156928b400f6SJacob Faibussowitsch             PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in POTRI Lapack routine %d",(int)B_ierr);
1570f4f7d9d6SStefano Zampini           } else if (use_sytr) {
1571f4f7d9d6SStefano Zampini             PetscStackCallBLAS("LAPACKsytrf",LAPACKsytrf_("L",&B_N,S_data,&B_N,pivots,Bwork,&B_lwork,&B_ierr));
157228b400f6SJacob Faibussowitsch             PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in SYTRF Lapack routine %d",(int)B_ierr);
1573f4f7d9d6SStefano Zampini             PetscStackCallBLAS("LAPACKsytri",LAPACKsytri_("L",&B_N,S_data,&B_N,pivots,Bwork,&B_ierr));
157428b400f6SJacob Faibussowitsch             PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in SYTRI Lapack routine %d",(int)B_ierr);
1575d6462365SStefano Zampini           } else {
1576d6462365SStefano Zampini             PetscStackCallBLAS("LAPACKgetrf",LAPACKgetrf_(&B_N,&B_N,S_data,&B_N,pivots,&B_ierr));
157728b400f6SJacob Faibussowitsch             PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in GETRF Lapack routine %d",(int)B_ierr);
1578d6462365SStefano Zampini             PetscStackCallBLAS("LAPACKgetri",LAPACKgetri_(&B_N,S_data,&B_N,pivots,Bwork,&B_lwork,&B_ierr));
157928b400f6SJacob Faibussowitsch             PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in GETRI Lapack routine %d",(int)B_ierr);
1580be83ff47SStefano Zampini           }
15819566063dSJacob Faibussowitsch           PetscCall(PetscLogFlops(1.0*size_schur*size_schur*size_schur));
15829566063dSJacob Faibussowitsch           PetscCall(PetscFPTrapPop());
15839566063dSJacob Faibussowitsch           PetscCall(MatDenseRestoreArray(S_all_inv,&S_data));
1584be83ff47SStefano Zampini         }
1585be83ff47SStefano Zampini         /* S_Ej_tilda_all */
1586be83ff47SStefano Zampini         cum = cum2 = 0;
15879566063dSJacob Faibussowitsch         PetscCall(MatDenseGetArrayRead(S_all_inv,&rS_data));
1588be83ff47SStefano Zampini         for (i=0;i<sub_schurs->n_subs;i++) {
1589be83ff47SStefano Zampini           PetscInt j;
1590862806e4SStefano Zampini 
15919566063dSJacob Faibussowitsch           PetscCall(ISGetLocalSize(sub_schurs->is_subs[i],&subset_size));
1592be83ff47SStefano Zampini           /* get (St^-1)_E */
159372b8c272SStefano Zampini           /* Unless we are changing the variables, I don't need to expand to upper triangular since St^-1
159406a4e24aSStefano Zampini              will be properly accessed later during adaptive selection */
1595a0b0af32SStefano Zampini           if (S_lower_triangular) {
1596be83ff47SStefano Zampini             PetscInt k;
1597b7ab4a40SStefano Zampini             if (sub_schurs->change) {
1598be83ff47SStefano Zampini               for (k=0;k<subset_size;k++) {
1599be83ff47SStefano Zampini                 for (j=k;j<subset_size;j++) {
16001683a169SBarry Smith                   work[k*subset_size+j] = rS_data[cum2+k*size_schur+j];
16016c3e6151SStefano Zampini                   work[j*subset_size+k] = work[k*subset_size+j];
1602be83ff47SStefano Zampini                 }
1603be83ff47SStefano Zampini               }
160472b8c272SStefano Zampini             } else {
160572b8c272SStefano Zampini               for (k=0;k<subset_size;k++) {
160672b8c272SStefano Zampini                 for (j=k;j<subset_size;j++) {
16071683a169SBarry Smith                   work[k*subset_size+j] = rS_data[cum2+k*size_schur+j];
160872b8c272SStefano Zampini                 }
160972b8c272SStefano Zampini               }
161072b8c272SStefano Zampini             }
161172b8c272SStefano Zampini           } else {
1612be83ff47SStefano Zampini             PetscInt k;
1613be83ff47SStefano Zampini             for (k=0;k<subset_size;k++) {
1614be83ff47SStefano Zampini               for (j=0;j<subset_size;j++) {
16151683a169SBarry Smith                 work[k*subset_size+j] = rS_data[cum2+k*size_schur+j];
1616be83ff47SStefano Zampini               }
1617be83ff47SStefano Zampini             }
1618be83ff47SStefano Zampini           }
1619b7ab4a40SStefano Zampini           if (sub_schurs->change) {
16208760537fSStefano Zampini             Mat change_sub,SEj,T;
162172b8c272SStefano Zampini 
162272b8c272SStefano Zampini             /* change basis */
16239566063dSJacob Faibussowitsch             PetscCall(KSPGetOperators(sub_schurs->change[i],&change_sub,NULL));
16249566063dSJacob Faibussowitsch             PetscCall(MatCreateSeqDense(PETSC_COMM_SELF,subset_size,subset_size,work,&SEj));
16258760537fSStefano Zampini             if (!sub_schurs->change_with_qr) { /* currently there's no support for PtAP with P SeqAIJ */
16268760537fSStefano Zampini               Mat T2;
16279566063dSJacob Faibussowitsch               PetscCall(MatTransposeMatMult(change_sub,SEj,MAT_INITIAL_MATRIX,1.0,&T2));
16289566063dSJacob Faibussowitsch               PetscCall(MatMatMult(T2,change_sub,MAT_INITIAL_MATRIX,1.0,&T));
16299566063dSJacob Faibussowitsch               PetscCall(MatDestroy(&T2));
16309566063dSJacob Faibussowitsch               PetscCall(MatConvert(T,MATSEQDENSE,MAT_INPLACE_MATRIX,&T));
16318760537fSStefano Zampini             } else {
16329566063dSJacob Faibussowitsch               PetscCall(MatPtAP(SEj,change_sub,MAT_INITIAL_MATRIX,1.0,&T));
163372b8c272SStefano Zampini             }
16349566063dSJacob Faibussowitsch             PetscCall(MatCopy(T,SEj,SAME_NONZERO_PATTERN));
16359566063dSJacob Faibussowitsch             PetscCall(MatDestroy(&T));
163672b8c272SStefano Zampini             /* set diagonal entry to a very large value to pick the basis we are eliminating as the first eigenvectors with adaptive selection */
16379566063dSJacob Faibussowitsch             PetscCall(MatZeroRowsColumnsIS(SEj,sub_schurs->change_primal_sub[i],1./PETSC_SMALL,NULL,NULL));
16389566063dSJacob Faibussowitsch             PetscCall(MatDestroy(&SEj));
163972b8c272SStefano Zampini           }
16409566063dSJacob Faibussowitsch           PetscCall(PetscArraycpy(SEjinv_arr,work,subset_size*subset_size));
1641be83ff47SStefano Zampini           cum += subset_size;
1642be83ff47SStefano Zampini           cum2 += subset_size*(size_schur + 1);
164304c5b2e6SStefano Zampini           SEjinv_arr += subset_size*subset_size;
1644883469d8SStefano Zampini         }
16459566063dSJacob Faibussowitsch         PetscCall(MatDenseRestoreArrayRead(S_all_inv,&rS_data));
1646df4d28bfSStefano Zampini         if (solver_S) {
16473fc34f97SStefano Zampini           if (schur_has_vertices) {
16489566063dSJacob Faibussowitsch             PetscCall(MatFactorRestoreSchurComplement(F,&S_all_inv,MAT_FACTOR_SCHUR_FACTORED));
16493fc34f97SStefano Zampini           } else {
16509566063dSJacob Faibussowitsch             PetscCall(MatFactorRestoreSchurComplement(F,&S_all_inv,MAT_FACTOR_SCHUR_INVERTED));
16515db18549SStefano Zampini           }
16523fc34f97SStefano Zampini         }
16539566063dSJacob Faibussowitsch         PetscCall(MatDestroy(&S_all_inv));
1654683d3df6SStefano Zampini       }
16559566063dSJacob Faibussowitsch       PetscCall(MatSeqAIJRestoreArray(sub_schurs->sum_S_Ej_tilda_all,&SEjinv_arr));
1656683d3df6SStefano Zampini 
16573fc34f97SStefano Zampini       /* move back factors if needed */
16583fc34f97SStefano Zampini       if (schur_has_vertices) {
1659683d3df6SStefano Zampini         Mat      S_tmp;
16603fc34f97SStefano Zampini         PetscInt nd = 0;
1661683d3df6SStefano Zampini 
166228b400f6SJacob Faibussowitsch         PetscCheck(solver_S,PETSC_COMM_SELF,PETSC_ERR_PLIB,"This should not happen");
16639566063dSJacob Faibussowitsch         PetscCall(MatFactorGetSchurComplement(F,&S_tmp,NULL));
1664f4f7d9d6SStefano Zampini         if (use_potr) {
1665683d3df6SStefano Zampini           PetscScalar *data;
1666683d3df6SStefano Zampini 
16679566063dSJacob Faibussowitsch           PetscCall(MatDenseGetArray(S_tmp,&data));
16689566063dSJacob Faibussowitsch           PetscCall(PetscArrayzero(data,size_schur*size_schur));
1669683d3df6SStefano Zampini 
1670683d3df6SStefano Zampini           if (S_lower_triangular) {
1671683d3df6SStefano Zampini             cum = 0;
1672683d3df6SStefano Zampini             for (i=0;i<size_active_schur;i++) {
16739566063dSJacob Faibussowitsch               PetscCall(PetscArraycpy(data+i*(size_schur+1),schur_factor+cum,size_active_schur-i));
1674683d3df6SStefano Zampini               cum += size_active_schur-i;
1675683d3df6SStefano Zampini             }
1676683d3df6SStefano Zampini           } else {
16779566063dSJacob Faibussowitsch             PetscCall(PetscArraycpy(data,schur_factor,size_schur*size_schur));
1678683d3df6SStefano Zampini           }
1679683d3df6SStefano Zampini           if (sub_schurs->is_dir) {
16809566063dSJacob Faibussowitsch             PetscCall(ISGetLocalSize(sub_schurs->is_dir,&nd));
1681683d3df6SStefano Zampini             for (i=0;i<nd;i++) {
1682683d3df6SStefano Zampini               data[(i+size_active_schur)*(size_schur+1)] = schur_factor[cum+i];
1683683d3df6SStefano Zampini             }
1684683d3df6SStefano Zampini           }
16856dba178dSStefano Zampini           /* workaround: since I cannot modify the matrices used inside the solvers for the forward and backward substitutions,
1686683d3df6SStefano Zampini              set the diagonal entry of the Schur factor to a very large value */
1687683d3df6SStefano Zampini           for (i=size_active_schur+nd;i<size_schur;i++) {
16886c3e6151SStefano Zampini             data[i*(size_schur+1)] = infty;
1689683d3df6SStefano Zampini           }
16909566063dSJacob Faibussowitsch           PetscCall(MatDenseRestoreArray(S_tmp,&data));
16916542c05fSStefano Zampini         } else SETERRQ(PETSC_COMM_SELF,PETSC_ERR_SUP,"Factor update not yet implemented for non SPD matrices");
16929566063dSJacob Faibussowitsch         PetscCall(MatFactorRestoreSchurComplement(F,&S_tmp,MAT_FACTOR_SCHUR_FACTORED));
16939087bf02SStefano Zampini       }
1694367aa537SStefano Zampini     } else if (factor_workaround) { /* we need to eliminate any unneeded coupling */
1695367aa537SStefano Zampini       PetscScalar *data;
1696367aa537SStefano Zampini       PetscInt    nd = 0;
1697367aa537SStefano Zampini 
1698367aa537SStefano Zampini       if (sub_schurs->is_dir) { /* dirichlet dofs could have different scalings */
16999566063dSJacob Faibussowitsch         PetscCall(ISGetLocalSize(sub_schurs->is_dir,&nd));
1700367aa537SStefano Zampini       }
17019566063dSJacob Faibussowitsch       PetscCall(MatFactorGetSchurComplement(F,&S_all,NULL));
17029566063dSJacob Faibussowitsch       PetscCall(MatDenseGetArray(S_all,&data));
1703367aa537SStefano Zampini       for (i=0;i<size_active_schur;i++) {
17049566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(data+i*size_schur+size_active_schur,size_schur-size_active_schur));
1705367aa537SStefano Zampini       }
1706367aa537SStefano Zampini       for (i=size_active_schur+nd;i<size_schur;i++) {
17079566063dSJacob Faibussowitsch         PetscCall(PetscArrayzero(data+i*size_schur+size_active_schur,size_schur-size_active_schur));
17086c3e6151SStefano Zampini         data[i*(size_schur+1)] = infty;
1709367aa537SStefano Zampini       }
17109566063dSJacob Faibussowitsch       PetscCall(MatDenseRestoreArray(S_all,&data));
17119566063dSJacob Faibussowitsch       PetscCall(MatFactorRestoreSchurComplement(F,&S_all,MAT_FACTOR_SCHUR_UNFACTORED));
17124a6c6b0dSStefano Zampini     }
17139566063dSJacob Faibussowitsch     PetscCall(PetscFree(work));
17149566063dSJacob Faibussowitsch     PetscCall(PetscFree(schur_factor));
17159566063dSJacob Faibussowitsch     PetscCall(VecDestroy(&Dall));
17164a6c6b0dSStefano Zampini   }
17179566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&is_I_layer));
17189566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&S_all));
17199566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&A_BB));
17209566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&A_IB));
17219566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&A_BI));
17229566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&F));
17236afe12f5SStefano Zampini 
17249566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(sub_schurs->n_subs,&nnz));
17256afe12f5SStefano Zampini   for (i=0;i<sub_schurs->n_subs;i++) {
17269566063dSJacob Faibussowitsch     PetscCall(ISGetLocalSize(sub_schurs->is_subs[i],&nnz[i]));
17276afe12f5SStefano Zampini   }
17289566063dSJacob Faibussowitsch   PetscCall(ISCreateGeneral(PETSC_COMM_SELF,sub_schurs->n_subs,nnz,PETSC_OWN_POINTER,&is_I_layer));
17299566063dSJacob Faibussowitsch   PetscCall(MatSetVariableBlockSizes(sub_schurs->S_Ej_all,sub_schurs->n_subs,nnz));
17309566063dSJacob Faibussowitsch   PetscCall(MatAssemblyBegin(sub_schurs->S_Ej_all,MAT_FINAL_ASSEMBLY));
17319566063dSJacob Faibussowitsch   PetscCall(MatAssemblyEnd(sub_schurs->S_Ej_all,MAT_FINAL_ASSEMBLY));
17325a95e1ceSStefano Zampini   if (compute_Stilda) {
17339566063dSJacob Faibussowitsch     PetscCall(MatSetVariableBlockSizes(sub_schurs->sum_S_Ej_tilda_all,sub_schurs->n_subs,nnz));
17349566063dSJacob Faibussowitsch     PetscCall(MatAssemblyBegin(sub_schurs->sum_S_Ej_tilda_all,MAT_FINAL_ASSEMBLY));
17359566063dSJacob Faibussowitsch     PetscCall(MatAssemblyEnd(sub_schurs->sum_S_Ej_tilda_all,MAT_FINAL_ASSEMBLY));
17369d54b7f4SStefano Zampini     if (deluxe) {
17379566063dSJacob Faibussowitsch       PetscCall(MatSetVariableBlockSizes(sub_schurs->sum_S_Ej_inv_all,sub_schurs->n_subs,nnz));
17389566063dSJacob Faibussowitsch       PetscCall(MatAssemblyBegin(sub_schurs->sum_S_Ej_inv_all,MAT_FINAL_ASSEMBLY));
17399566063dSJacob Faibussowitsch       PetscCall(MatAssemblyEnd(sub_schurs->sum_S_Ej_inv_all,MAT_FINAL_ASSEMBLY));
174008122e43SStefano Zampini     }
17419d54b7f4SStefano Zampini   }
17429566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&is_I_layer));
17436afe12f5SStefano Zampini 
17445db18549SStefano Zampini   /* Get local part of (\sum_j S_Ej) */
174541fd5443SStefano Zampini   if (!sub_schurs->sum_S_Ej_all) {
17469566063dSJacob Faibussowitsch     PetscCall(MatDuplicate(sub_schurs->S_Ej_all,MAT_DO_NOT_COPY_VALUES,&sub_schurs->sum_S_Ej_all));
174741fd5443SStefano Zampini   }
17489566063dSJacob Faibussowitsch   PetscCall(VecSet(gstash,0.0));
17499566063dSJacob Faibussowitsch   PetscCall(MatSeqAIJGetArray(sub_schurs->S_Ej_all,&stasharray));
17509566063dSJacob Faibussowitsch   PetscCall(VecPlaceArray(lstash,stasharray));
17519566063dSJacob Faibussowitsch   PetscCall(VecScatterBegin(sstash,lstash,gstash,ADD_VALUES,SCATTER_FORWARD));
17529566063dSJacob Faibussowitsch   PetscCall(VecScatterEnd(sstash,lstash,gstash,ADD_VALUES,SCATTER_FORWARD));
17539566063dSJacob Faibussowitsch   PetscCall(MatSeqAIJRestoreArray(sub_schurs->S_Ej_all,&stasharray));
17549566063dSJacob Faibussowitsch   PetscCall(VecResetArray(lstash));
17559566063dSJacob Faibussowitsch   PetscCall(MatSeqAIJGetArray(sub_schurs->sum_S_Ej_all,&stasharray));
17569566063dSJacob Faibussowitsch   PetscCall(VecPlaceArray(lstash,stasharray));
17579566063dSJacob Faibussowitsch   PetscCall(VecScatterBegin(sstash,gstash,lstash,INSERT_VALUES,SCATTER_REVERSE));
17589566063dSJacob Faibussowitsch   PetscCall(VecScatterEnd(sstash,gstash,lstash,INSERT_VALUES,SCATTER_REVERSE));
17599566063dSJacob Faibussowitsch   PetscCall(MatSeqAIJRestoreArray(sub_schurs->sum_S_Ej_all,&stasharray));
17609566063dSJacob Faibussowitsch   PetscCall(VecResetArray(lstash));
176108122e43SStefano Zampini 
1762f6f667cfSStefano Zampini   /* Get local part of (\sum_j S^-1_Ej) (\sum_j St^-1_Ej) */
17635a95e1ceSStefano Zampini   if (compute_Stilda) {
17649566063dSJacob Faibussowitsch     PetscCall(VecSet(gstash,0.0));
17659566063dSJacob Faibussowitsch     PetscCall(MatSeqAIJGetArray(sub_schurs->sum_S_Ej_tilda_all,&stasharray));
17669566063dSJacob Faibussowitsch     PetscCall(VecPlaceArray(lstash,stasharray));
17679566063dSJacob Faibussowitsch     PetscCall(VecScatterBegin(sstash,lstash,gstash,ADD_VALUES,SCATTER_FORWARD));
17689566063dSJacob Faibussowitsch     PetscCall(VecScatterEnd(sstash,lstash,gstash,ADD_VALUES,SCATTER_FORWARD));
17699566063dSJacob Faibussowitsch     PetscCall(VecScatterBegin(sstash,gstash,lstash,INSERT_VALUES,SCATTER_REVERSE));
17709566063dSJacob Faibussowitsch     PetscCall(VecScatterEnd(sstash,gstash,lstash,INSERT_VALUES,SCATTER_REVERSE));
17719566063dSJacob Faibussowitsch     PetscCall(MatSeqAIJRestoreArray(sub_schurs->sum_S_Ej_tilda_all,&stasharray));
17729566063dSJacob Faibussowitsch     PetscCall(VecResetArray(lstash));
17739d54b7f4SStefano Zampini     if (deluxe) {
17749566063dSJacob Faibussowitsch       PetscCall(VecSet(gstash,0.0));
17759566063dSJacob Faibussowitsch       PetscCall(MatSeqAIJGetArray(sub_schurs->sum_S_Ej_inv_all,&stasharray));
17769566063dSJacob Faibussowitsch       PetscCall(VecPlaceArray(lstash,stasharray));
17779566063dSJacob Faibussowitsch       PetscCall(VecScatterBegin(sstash,lstash,gstash,ADD_VALUES,SCATTER_FORWARD));
17789566063dSJacob Faibussowitsch       PetscCall(VecScatterEnd(sstash,lstash,gstash,ADD_VALUES,SCATTER_FORWARD));
17799566063dSJacob Faibussowitsch       PetscCall(VecScatterBegin(sstash,gstash,lstash,INSERT_VALUES,SCATTER_REVERSE));
17809566063dSJacob Faibussowitsch       PetscCall(VecScatterEnd(sstash,gstash,lstash,INSERT_VALUES,SCATTER_REVERSE));
17819566063dSJacob Faibussowitsch       PetscCall(MatSeqAIJRestoreArray(sub_schurs->sum_S_Ej_inv_all,&stasharray));
17829566063dSJacob Faibussowitsch       PetscCall(VecResetArray(lstash));
17839d54b7f4SStefano Zampini     } else {
17849d54b7f4SStefano Zampini       PetscScalar *array;
17859d54b7f4SStefano Zampini       PetscInt    cum;
17869d54b7f4SStefano Zampini 
17879566063dSJacob Faibussowitsch       PetscCall(MatSeqAIJGetArray(sub_schurs->sum_S_Ej_tilda_all,&array));
17889d54b7f4SStefano Zampini       cum = 0;
17899d54b7f4SStefano Zampini       for (i=0;i<sub_schurs->n_subs;i++) {
17909566063dSJacob Faibussowitsch         PetscCall(ISGetLocalSize(sub_schurs->is_subs[i],&subset_size));
17919566063dSJacob Faibussowitsch         PetscCall(PetscBLASIntCast(subset_size,&B_N));
17929566063dSJacob Faibussowitsch         PetscCall(PetscFPTrapPush(PETSC_FP_TRAP_OFF));
1793f4f7d9d6SStefano Zampini         if (use_potr) {
17949d54b7f4SStefano Zampini           PetscStackCallBLAS("LAPACKpotrf",LAPACKpotrf_("L",&B_N,array+cum,&B_N,&B_ierr));
179528b400f6SJacob Faibussowitsch           PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in POTRF Lapack routine %d",(int)B_ierr);
17969d54b7f4SStefano Zampini           PetscStackCallBLAS("LAPACKpotri",LAPACKpotri_("L",&B_N,array+cum,&B_N,&B_ierr));
179728b400f6SJacob Faibussowitsch           PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in POTRI Lapack routine %d",(int)B_ierr);
1798f4f7d9d6SStefano Zampini         } else if (use_sytr) {
1799f4f7d9d6SStefano Zampini           PetscStackCallBLAS("LAPACKsytrf",LAPACKsytrf_("L",&B_N,array+cum,&B_N,pivots,Bwork,&B_lwork,&B_ierr));
180028b400f6SJacob Faibussowitsch           PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in SYTRF Lapack routine %d",(int)B_ierr);
1801f4f7d9d6SStefano Zampini           PetscStackCallBLAS("LAPACKsytri",LAPACKsytri_("L",&B_N,array+cum,&B_N,pivots,Bwork,&B_ierr));
180228b400f6SJacob Faibussowitsch           PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in SYTRI Lapack routine %d",(int)B_ierr);
1803f4f7d9d6SStefano Zampini         } else {
1804f4f7d9d6SStefano Zampini           PetscStackCallBLAS("LAPACKgetrf",LAPACKgetrf_(&B_N,&B_N,array+cum,&B_N,pivots,&B_ierr));
180528b400f6SJacob Faibussowitsch           PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in GETRF Lapack routine %d",(int)B_ierr);
1806f4f7d9d6SStefano Zampini           PetscStackCallBLAS("LAPACKgetri",LAPACKgetri_(&B_N,array+cum,&B_N,pivots,Bwork,&B_lwork,&B_ierr));
180728b400f6SJacob Faibussowitsch           PetscCheck(!B_ierr,PETSC_COMM_SELF,PETSC_ERR_LIB,"Error in GETRI Lapack routine %d",(int)B_ierr);
1808f4f7d9d6SStefano Zampini         }
18099566063dSJacob Faibussowitsch         PetscCall(PetscLogFlops(1.0*subset_size*subset_size*subset_size));
18109566063dSJacob Faibussowitsch         PetscCall(PetscFPTrapPop());
18119d54b7f4SStefano Zampini         cum += subset_size*subset_size;
18129d54b7f4SStefano Zampini       }
18139566063dSJacob Faibussowitsch       PetscCall(MatSeqAIJRestoreArray(sub_schurs->sum_S_Ej_tilda_all,&array));
18149566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)sub_schurs->sum_S_Ej_all));
18159566063dSJacob Faibussowitsch       PetscCall(MatDestroy(&sub_schurs->sum_S_Ej_inv_all));
18169d54b7f4SStefano Zampini       sub_schurs->sum_S_Ej_inv_all = sub_schurs->sum_S_Ej_all;
18179d54b7f4SStefano Zampini     }
181808122e43SStefano Zampini   }
18199566063dSJacob Faibussowitsch   PetscCall(VecDestroy(&lstash));
18209566063dSJacob Faibussowitsch   PetscCall(VecDestroy(&gstash));
18219566063dSJacob Faibussowitsch   PetscCall(VecScatterDestroy(&sstash));
182257a87bf3SStefano Zampini 
18233b03f7bbSStefano Zampini   if (matl_dbg_viewer) {
182411955456SStefano Zampini     PetscInt cum;
182511955456SStefano Zampini 
182611955456SStefano Zampini     if (sub_schurs->S_Ej_all) {
18279566063dSJacob Faibussowitsch       PetscCall(PetscObjectSetName((PetscObject)sub_schurs->S_Ej_all,"SE"));
18289566063dSJacob Faibussowitsch       PetscCall(MatView(sub_schurs->S_Ej_all,matl_dbg_viewer));
182911955456SStefano Zampini     }
183011955456SStefano Zampini     if (sub_schurs->sum_S_Ej_all) {
18319566063dSJacob Faibussowitsch       PetscCall(PetscObjectSetName((PetscObject)sub_schurs->sum_S_Ej_all,"SSE"));
18329566063dSJacob Faibussowitsch       PetscCall(MatView(sub_schurs->sum_S_Ej_all,matl_dbg_viewer));
183311955456SStefano Zampini     }
183411955456SStefano Zampini     if (sub_schurs->sum_S_Ej_inv_all) {
18359566063dSJacob Faibussowitsch       PetscCall(PetscObjectSetName((PetscObject)sub_schurs->sum_S_Ej_inv_all,"SSEm"));
18369566063dSJacob Faibussowitsch       PetscCall(MatView(sub_schurs->sum_S_Ej_inv_all,matl_dbg_viewer));
183711955456SStefano Zampini     }
183811955456SStefano Zampini     if (sub_schurs->sum_S_Ej_tilda_all) {
18399566063dSJacob Faibussowitsch       PetscCall(PetscObjectSetName((PetscObject)sub_schurs->sum_S_Ej_tilda_all,"SSEt"));
18409566063dSJacob Faibussowitsch       PetscCall(MatView(sub_schurs->sum_S_Ej_tilda_all,matl_dbg_viewer));
184111955456SStefano Zampini     }
184211955456SStefano Zampini     for (i=0,cum=0;i<sub_schurs->n_subs;i++) {
184311955456SStefano Zampini       IS   is;
184411955456SStefano Zampini       char name[16];
184511955456SStefano Zampini 
18469566063dSJacob Faibussowitsch       PetscCall(PetscSNPrintf(name,sizeof(name),"IE%D",i));
18479566063dSJacob Faibussowitsch       PetscCall(ISGetLocalSize(sub_schurs->is_subs[i],&subset_size));
18489566063dSJacob Faibussowitsch       PetscCall(ISCreateStride(PETSC_COMM_SELF,subset_size,cum,1,&is));
18499566063dSJacob Faibussowitsch       PetscCall(PetscObjectSetName((PetscObject)is,name));
18509566063dSJacob Faibussowitsch       PetscCall(ISView(is,matl_dbg_viewer));
18519566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&is));
185211955456SStefano Zampini       cum += subset_size;
185311955456SStefano Zampini     }
185411955456SStefano Zampini   }
18553202ece2SStefano Zampini 
18565a95e1ceSStefano Zampini   /* free workspace */
18579566063dSJacob Faibussowitsch   PetscCall(PetscViewerDestroy(&matl_dbg_viewer));
18589566063dSJacob Faibussowitsch   PetscCall(PetscFree2(Bwork,pivots));
18599566063dSJacob Faibussowitsch   PetscCall(PetscCommDestroy(&comm_n));
1860b1b3d7a2SStefano Zampini   PetscFunctionReturn(0);
1861b1b3d7a2SStefano Zampini }
1862b1b3d7a2SStefano Zampini 
186388113c35SStefano Zampini PetscErrorCode PCBDDCSubSchursInit(PCBDDCSubSchurs sub_schurs, const char* prefix, IS is_I, IS is_B, PCBDDCGraph graph, ISLocalToGlobalMapping BtoNmap, PetscBool copycc)
1864b1b3d7a2SStefano Zampini {
18659bb4a8caSStefano Zampini   IS              *faces,*edges,*all_cc,vertices;
18665a95e1ceSStefano Zampini   PetscInt        i,n_faces,n_edges,n_all_cc;
1867365a3a41SStefano Zampini   PetscBool       is_sorted,ispardiso,ismumps;
1868b1b3d7a2SStefano Zampini   PetscErrorCode  ierr;
1869b1b3d7a2SStefano Zampini 
1870b1b3d7a2SStefano Zampini   PetscFunctionBegin;
18719566063dSJacob Faibussowitsch   PetscCall(ISSorted(is_I,&is_sorted));
187228b400f6SJacob Faibussowitsch   PetscCheck(is_sorted,PetscObjectComm((PetscObject)is_I),PETSC_ERR_PLIB,"IS for I dofs should be shorted");
18739566063dSJacob Faibussowitsch   PetscCall(ISSorted(is_B,&is_sorted));
187428b400f6SJacob Faibussowitsch   PetscCheck(is_sorted,PetscObjectComm((PetscObject)is_B),PETSC_ERR_PLIB,"IS for B dofs should be shorted");
1875b1b3d7a2SStefano Zampini 
1876b1b3d7a2SStefano Zampini   /* reset any previous data */
18779566063dSJacob Faibussowitsch   PetscCall(PCBDDCSubSchursReset(sub_schurs));
1878b1b3d7a2SStefano Zampini 
18795a95e1ceSStefano Zampini   /* get index sets for faces and edges (already sorted by global ordering) */
18809566063dSJacob Faibussowitsch   PetscCall(PCBDDCGraphGetCandidatesIS(graph,&n_faces,&faces,&n_edges,&edges,&vertices));
1881b1b3d7a2SStefano Zampini   n_all_cc = n_faces+n_edges;
18829566063dSJacob Faibussowitsch   PetscCall(PetscBTCreate(n_all_cc,&sub_schurs->is_edge));
18839566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(n_all_cc,&all_cc));
1884b1b3d7a2SStefano Zampini   for (i=0;i<n_faces;i++) {
18858b6046baSStefano Zampini     if (copycc) {
18869566063dSJacob Faibussowitsch       PetscCall(ISDuplicate(faces[i],&all_cc[i]));
18878b6046baSStefano Zampini     } else {
18889566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)faces[i]));
1889b1b3d7a2SStefano Zampini       all_cc[i] = faces[i];
1890b1b3d7a2SStefano Zampini     }
18918b6046baSStefano Zampini   }
1892b1b3d7a2SStefano Zampini   for (i=0;i<n_edges;i++) {
18938b6046baSStefano Zampini     if (copycc) {
18949566063dSJacob Faibussowitsch       PetscCall(ISDuplicate(edges[i],&all_cc[n_faces+i]));
18958b6046baSStefano Zampini     } else {
18969566063dSJacob Faibussowitsch       PetscCall(PetscObjectReference((PetscObject)edges[i]));
1897b1b3d7a2SStefano Zampini       all_cc[n_faces+i] = edges[i];
18988b6046baSStefano Zampini     }
18999566063dSJacob Faibussowitsch     PetscCall(PetscBTSet(sub_schurs->is_edge,n_faces+i));
1900b1b3d7a2SStefano Zampini   }
19019566063dSJacob Faibussowitsch   PetscCall(PetscObjectReference((PetscObject)vertices));
1902c8272957SStefano Zampini   sub_schurs->is_vertices = vertices;
19039566063dSJacob Faibussowitsch   PetscCall(PCBDDCGraphRestoreCandidatesIS(graph,&n_faces,&faces,&n_edges,&edges,&vertices));
1904d62866d3SStefano Zampini   sub_schurs->is_dir = NULL;
19059566063dSJacob Faibussowitsch   PetscCall(PCBDDCGraphGetDirichletDofsB(graph,&sub_schurs->is_dir));
1906b1b3d7a2SStefano Zampini 
1907df4d28bfSStefano Zampini   /* Determine if MatFactor can be used */
19089566063dSJacob Faibussowitsch   PetscCall(PetscStrallocpy(prefix,&sub_schurs->prefix));
1909883469d8SStefano Zampini #if defined(PETSC_HAVE_MUMPS)
19109566063dSJacob Faibussowitsch   PetscCall(PetscStrncpy(sub_schurs->mat_solver_type,MATSOLVERMUMPS,sizeof(sub_schurs->mat_solver_type)));
191188113c35SStefano Zampini #elif defined(PETSC_HAVE_MKL_PARDISO)
19129566063dSJacob Faibussowitsch   PetscCall(PetscStrncpy(sub_schurs->mat_solver_type,MATSOLVERMKL_PARDISO,sizeof(sub_schurs->mat_solver_type)));
191388113c35SStefano Zampini #else
19149566063dSJacob Faibussowitsch   PetscCall(PetscStrncpy(sub_schurs->mat_solver_type,MATSOLVERPETSC,sizeof(sub_schurs->mat_solver_type)));
1915df4d28bfSStefano Zampini #endif
191688113c35SStefano Zampini #if defined(PETSC_USE_COMPLEX)
191788113c35SStefano Zampini   sub_schurs->is_hermitian  = PETSC_FALSE; /* Hermitian Cholesky is not supported by PETSc and external packages */
191888113c35SStefano Zampini #else
191988113c35SStefano Zampini   sub_schurs->is_hermitian  = PETSC_TRUE;
1920883469d8SStefano Zampini #endif
192188113c35SStefano Zampini   sub_schurs->is_posdef     = PETSC_TRUE;
192211955456SStefano Zampini   sub_schurs->is_symmetric  = PETSC_TRUE;
19237f9db97bSStefano Zampini   sub_schurs->debug         = PETSC_FALSE;
1924991c41b4SStefano Zampini   sub_schurs->restrict_comm = PETSC_FALSE;
19259566063dSJacob Faibussowitsch   ierr = PetscOptionsBegin(PetscObjectComm((PetscObject)graph->l2gmap),sub_schurs->prefix,"BDDC sub_schurs options","PC");PetscCall(ierr);
19269566063dSJacob Faibussowitsch   PetscCall(PetscOptionsString("-sub_schurs_mat_solver_type","Specific direct solver to use",NULL,sub_schurs->mat_solver_type,sub_schurs->mat_solver_type,sizeof(sub_schurs->mat_solver_type),NULL));
19279566063dSJacob Faibussowitsch   PetscCall(PetscOptionsBool("-sub_schurs_symmetric","Symmetric problem",NULL,sub_schurs->is_symmetric,&sub_schurs->is_symmetric,NULL));
19289566063dSJacob Faibussowitsch   PetscCall(PetscOptionsBool("-sub_schurs_hermitian","Hermitian problem",NULL,sub_schurs->is_hermitian,&sub_schurs->is_hermitian,NULL));
19299566063dSJacob Faibussowitsch   PetscCall(PetscOptionsBool("-sub_schurs_posdef","Positive definite problem",NULL,sub_schurs->is_posdef,&sub_schurs->is_posdef,NULL));
19309566063dSJacob Faibussowitsch   PetscCall(PetscOptionsBool("-sub_schurs_restrictcomm","Restrict communicator on active processes only",NULL,sub_schurs->restrict_comm,&sub_schurs->restrict_comm,NULL));
19319566063dSJacob Faibussowitsch   PetscCall(PetscOptionsBool("-sub_schurs_debug","Debug output",NULL,sub_schurs->debug,&sub_schurs->debug,NULL));
19329566063dSJacob Faibussowitsch   ierr = PetscOptionsEnd();PetscCall(ierr);
19339566063dSJacob Faibussowitsch   PetscCall(PetscStrcmp(sub_schurs->mat_solver_type,MATSOLVERMUMPS,&ismumps));
19349566063dSJacob Faibussowitsch   PetscCall(PetscStrcmp(sub_schurs->mat_solver_type,MATSOLVERMKL_PARDISO,&ispardiso));
1935365a3a41SStefano Zampini   sub_schurs->schur_explicit = (PetscBool)(ispardiso || ismumps);
1936b1b3d7a2SStefano Zampini 
193711955456SStefano Zampini   /* for reals, symmetric and hermitian are synonims */
193811955456SStefano Zampini #if !defined(PETSC_USE_COMPLEX)
193911955456SStefano Zampini   sub_schurs->is_symmetric = (PetscBool)(sub_schurs->is_symmetric && sub_schurs->is_hermitian);
194011955456SStefano Zampini   sub_schurs->is_hermitian = sub_schurs->is_symmetric;
194111955456SStefano Zampini #endif
194211955456SStefano Zampini 
19439566063dSJacob Faibussowitsch   PetscCall(PetscObjectReference((PetscObject)is_I));
1944b1b3d7a2SStefano Zampini   sub_schurs->is_I = is_I;
19459566063dSJacob Faibussowitsch   PetscCall(PetscObjectReference((PetscObject)is_B));
1946b1b3d7a2SStefano Zampini   sub_schurs->is_B = is_B;
19479566063dSJacob Faibussowitsch   PetscCall(PetscObjectReference((PetscObject)graph->l2gmap));
19485db18549SStefano Zampini   sub_schurs->l2gmap = graph->l2gmap;
19499566063dSJacob Faibussowitsch   PetscCall(PetscObjectReference((PetscObject)BtoNmap));
19505db18549SStefano Zampini   sub_schurs->BtoNmap = BtoNmap;
19515a95e1ceSStefano Zampini   sub_schurs->n_subs = n_all_cc;
1952b1b3d7a2SStefano Zampini   sub_schurs->is_subs = all_cc;
1953b96c3477SStefano Zampini   sub_schurs->S_Ej_all = NULL;
1954b96c3477SStefano Zampini   sub_schurs->sum_S_Ej_all = NULL;
195508122e43SStefano Zampini   sub_schurs->sum_S_Ej_inv_all = NULL;
1956b96c3477SStefano Zampini   sub_schurs->sum_S_Ej_tilda_all = NULL;
1957b96c3477SStefano Zampini   sub_schurs->is_Ej_all = NULL;
1958b1b3d7a2SStefano Zampini   PetscFunctionReturn(0);
1959b1b3d7a2SStefano Zampini }
1960b1b3d7a2SStefano Zampini 
196134a97f8cSStefano Zampini PetscErrorCode PCBDDCSubSchursCreate(PCBDDCSubSchurs *sub_schurs)
196234a97f8cSStefano Zampini {
196334a97f8cSStefano Zampini   PCBDDCSubSchurs schurs_ctx;
196434a97f8cSStefano Zampini 
196534a97f8cSStefano Zampini   PetscFunctionBegin;
19669566063dSJacob Faibussowitsch   PetscCall(PetscNew(&schurs_ctx));
19675ff63025SStefano Zampini   schurs_ctx->n_subs = 0;
196834a97f8cSStefano Zampini   *sub_schurs = schurs_ctx;
196934a97f8cSStefano Zampini   PetscFunctionReturn(0);
197034a97f8cSStefano Zampini }
197134a97f8cSStefano Zampini 
197234a97f8cSStefano Zampini PetscErrorCode PCBDDCSubSchursReset(PCBDDCSubSchurs sub_schurs)
197334a97f8cSStefano Zampini {
197434a97f8cSStefano Zampini   PetscInt       i;
197534a97f8cSStefano Zampini 
197634a97f8cSStefano Zampini   PetscFunctionBegin;
1977aea80f77Sstefano_zampini   if (!sub_schurs) PetscFunctionReturn(0);
19789566063dSJacob Faibussowitsch   PetscCall(PetscFree(sub_schurs->prefix));
19799566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&sub_schurs->A));
19809566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&sub_schurs->S));
19819566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&sub_schurs->is_I));
19829566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&sub_schurs->is_B));
19839566063dSJacob Faibussowitsch   PetscCall(ISLocalToGlobalMappingDestroy(&sub_schurs->l2gmap));
19849566063dSJacob Faibussowitsch   PetscCall(ISLocalToGlobalMappingDestroy(&sub_schurs->BtoNmap));
19859566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&sub_schurs->S_Ej_all));
19869566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&sub_schurs->sum_S_Ej_all));
19879566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&sub_schurs->sum_S_Ej_inv_all));
19889566063dSJacob Faibussowitsch   PetscCall(MatDestroy(&sub_schurs->sum_S_Ej_tilda_all));
19899566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&sub_schurs->is_Ej_all));
19909566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&sub_schurs->is_vertices));
19919566063dSJacob Faibussowitsch   PetscCall(ISDestroy(&sub_schurs->is_dir));
19929566063dSJacob Faibussowitsch   PetscCall(PetscBTDestroy(&sub_schurs->is_edge));
199334a97f8cSStefano Zampini   for (i=0;i<sub_schurs->n_subs;i++) {
19949566063dSJacob Faibussowitsch     PetscCall(ISDestroy(&sub_schurs->is_subs[i]));
199534a97f8cSStefano Zampini   }
19965ff63025SStefano Zampini   if (sub_schurs->n_subs) {
19979566063dSJacob Faibussowitsch     PetscCall(PetscFree(sub_schurs->is_subs));
19983dc780c3SStefano Zampini   }
1999df4d28bfSStefano Zampini   if (sub_schurs->reuse_solver) {
20009566063dSJacob Faibussowitsch     PetscCall(PCBDDCReuseSolversReset(sub_schurs->reuse_solver));
2001d62866d3SStefano Zampini   }
20029566063dSJacob Faibussowitsch   PetscCall(PetscFree(sub_schurs->reuse_solver));
200372b8c272SStefano Zampini   if (sub_schurs->change) {
200472b8c272SStefano Zampini     for (i=0;i<sub_schurs->n_subs;i++) {
20059566063dSJacob Faibussowitsch       PetscCall(KSPDestroy(&sub_schurs->change[i]));
20069566063dSJacob Faibussowitsch       PetscCall(ISDestroy(&sub_schurs->change_primal_sub[i]));
200772b8c272SStefano Zampini     }
200872b8c272SStefano Zampini   }
20099566063dSJacob Faibussowitsch   PetscCall(PetscFree(sub_schurs->change));
20109566063dSJacob Faibussowitsch   PetscCall(PetscFree(sub_schurs->change_primal_sub));
201134a97f8cSStefano Zampini   sub_schurs->n_subs = 0;
201234a97f8cSStefano Zampini   PetscFunctionReturn(0);
201334a97f8cSStefano Zampini }
201434a97f8cSStefano Zampini 
2015aea80f77Sstefano_zampini PetscErrorCode PCBDDCSubSchursDestroy(PCBDDCSubSchurs* sub_schurs)
2016aea80f77Sstefano_zampini {
2017aea80f77Sstefano_zampini   PetscFunctionBegin;
20189566063dSJacob Faibussowitsch   PetscCall(PCBDDCSubSchursReset(*sub_schurs));
20199566063dSJacob Faibussowitsch   PetscCall(PetscFree(*sub_schurs));
2020aea80f77Sstefano_zampini   PetscFunctionReturn(0);
2021aea80f77Sstefano_zampini }
2022aea80f77Sstefano_zampini 
20239fbee547SJacob Faibussowitsch static inline PetscErrorCode PCBDDCAdjGetNextLayer_Private(PetscInt* queue_tip,PetscInt n_prev,PetscBT touched,PetscInt* xadj,PetscInt* adjncy,PetscInt* n_added)
202434a97f8cSStefano Zampini {
202534a97f8cSStefano Zampini   PetscInt       i,j,n;
202634a97f8cSStefano Zampini 
202734a97f8cSStefano Zampini   PetscFunctionBegin;
202834a97f8cSStefano Zampini   n = 0;
202934a97f8cSStefano Zampini   for (i=-n_prev;i<0;i++) {
203034a97f8cSStefano Zampini     PetscInt start_dof = queue_tip[i];
203134a97f8cSStefano Zampini     for (j=xadj[start_dof];j<xadj[start_dof+1];j++) {
203234a97f8cSStefano Zampini       PetscInt dof = adjncy[j];
203334a97f8cSStefano Zampini       if (!PetscBTLookup(touched,dof)) {
20349566063dSJacob Faibussowitsch         PetscCall(PetscBTSet(touched,dof));
203534a97f8cSStefano Zampini         queue_tip[n] = dof;
203634a97f8cSStefano Zampini         n++;
203734a97f8cSStefano Zampini       }
203834a97f8cSStefano Zampini     }
203934a97f8cSStefano Zampini   }
204034a97f8cSStefano Zampini   *n_added = n;
204134a97f8cSStefano Zampini   PetscFunctionReturn(0);
204234a97f8cSStefano Zampini }
2043