xref: /petsc/src/mat/impls/baij/seq/baijfact2.c (revision e8c0849ab8fe171bed529bea27238c9b402db591)
14e2b4712SSatish Balay /*
24e2b4712SSatish Balay     Factorization code for BAIJ format.
34e2b4712SSatish Balay */
44e2b4712SSatish Balay 
5c6db04a5SJed Brown #include <../src/mat/impls/baij/seq/baij.h>
6af0996ceSBarry Smith #include <petsc/private/kernels/blockinvert.h>
7c6db04a5SJed Brown #include <petscbt.h>
8c6db04a5SJed Brown #include <../src/mat/utils/freespace.h>
94e2b4712SSatish Balay 
10d6acfc2dSPierre Jolivet PETSC_INTERN PetscErrorCode MatDuplicateNoCreate_SeqBAIJ(Mat, Mat, MatDuplicateOption, PetscBool);
116bce7ff8SHong Zhang 
12766f9fbaSBarry Smith /*
13766f9fbaSBarry Smith    This is not much faster than MatLUFactorNumeric_SeqBAIJ_N() but the solve is faster at least sometimes
14766f9fbaSBarry Smith */
MatLUFactorNumeric_SeqBAIJ_15_NaturalOrdering(Mat B,Mat A,const MatFactorInfo * info)15d71ae5a4SJacob Faibussowitsch PetscErrorCode MatLUFactorNumeric_SeqBAIJ_15_NaturalOrdering(Mat B, Mat A, const MatFactorInfo *info)
16d71ae5a4SJacob Faibussowitsch {
172b0b2ea7SShri Abhyankar   Mat              C = B;
182b0b2ea7SShri Abhyankar   Mat_SeqBAIJ     *a = (Mat_SeqBAIJ *)A->data, *b = (Mat_SeqBAIJ *)C->data;
19766f9fbaSBarry Smith   PetscInt         i, j, k, ipvt[15];
20766f9fbaSBarry Smith   const PetscInt   n = a->mbs, *ai = a->i, *aj = a->j, *bi = b->i, *bj = b->j, *ajtmp, *bjtmp, *bdiag = b->diag, *pj;
21766f9fbaSBarry Smith   PetscInt         nz, nzL, row;
22766f9fbaSBarry Smith   MatScalar       *rtmp, *pc, *mwork, *pv, *vv, work[225];
23766f9fbaSBarry Smith   const MatScalar *v, *aa = a->a;
242b0b2ea7SShri Abhyankar   PetscInt         bs2 = a->bs2, bs = A->rmap->bs, flg;
250fa040f9SShri Abhyankar   PetscInt         sol_ver;
26a455e926SHong Zhang   PetscBool        allowzeropivot, zeropivotdetected;
272b0b2ea7SShri Abhyankar 
282b0b2ea7SShri Abhyankar   PetscFunctionBegin;
290164db54SHong Zhang   allowzeropivot = PetscNot(A->erroriffailure);
309566063dSJacob Faibussowitsch   PetscCall(PetscOptionsGetInt(NULL, ((PetscObject)A)->prefix, "-sol_ver", &sol_ver, NULL));
310fa040f9SShri Abhyankar 
322b0b2ea7SShri Abhyankar   /* generate work space needed by the factorization */
339566063dSJacob Faibussowitsch   PetscCall(PetscMalloc2(bs2 * n, &rtmp, bs2, &mwork));
349566063dSJacob Faibussowitsch   PetscCall(PetscArrayzero(rtmp, bs2 * n));
352b0b2ea7SShri Abhyankar 
362b0b2ea7SShri Abhyankar   for (i = 0; i < n; i++) {
372b0b2ea7SShri Abhyankar     /* zero rtmp */
382b0b2ea7SShri Abhyankar     /* L part */
392b0b2ea7SShri Abhyankar     nz    = bi[i + 1] - bi[i];
402b0b2ea7SShri Abhyankar     bjtmp = bj + bi[i];
4148a46eb9SPierre Jolivet     for (j = 0; j < nz; j++) PetscCall(PetscArrayzero(rtmp + bs2 * bjtmp[j], bs2));
422b0b2ea7SShri Abhyankar 
432b0b2ea7SShri Abhyankar     /* U part */
442b0b2ea7SShri Abhyankar     nz    = bdiag[i] - bdiag[i + 1];
452b0b2ea7SShri Abhyankar     bjtmp = bj + bdiag[i + 1] + 1;
4648a46eb9SPierre Jolivet     for (j = 0; j < nz; j++) PetscCall(PetscArrayzero(rtmp + bs2 * bjtmp[j], bs2));
472b0b2ea7SShri Abhyankar 
482b0b2ea7SShri Abhyankar     /* load in initial (unfactored row) */
4929a97285SShri Abhyankar     nz    = ai[i + 1] - ai[i];
5029a97285SShri Abhyankar     ajtmp = aj + ai[i];
5129a97285SShri Abhyankar     v     = aa + bs2 * ai[i];
5248a46eb9SPierre Jolivet     for (j = 0; j < nz; j++) PetscCall(PetscArraycpy(rtmp + bs2 * ajtmp[j], v + bs2 * j, bs2));
532b0b2ea7SShri Abhyankar 
542b0b2ea7SShri Abhyankar     /* elimination */
552b0b2ea7SShri Abhyankar     bjtmp = bj + bi[i];
562b0b2ea7SShri Abhyankar     nzL   = bi[i + 1] - bi[i];
572b0b2ea7SShri Abhyankar     for (k = 0; k < nzL; k++) {
582b0b2ea7SShri Abhyankar       row = bjtmp[k];
592b0b2ea7SShri Abhyankar       pc  = rtmp + bs2 * row;
60c35f09e5SBarry Smith       for (flg = 0, j = 0; j < bs2; j++) {
61c35f09e5SBarry Smith         if (pc[j] != 0.0) {
62c35f09e5SBarry Smith           flg = 1;
63c35f09e5SBarry Smith           break;
64c35f09e5SBarry Smith         }
65c35f09e5SBarry Smith       }
662b0b2ea7SShri Abhyankar       if (flg) {
672b0b2ea7SShri Abhyankar         pv = b->a + bs2 * bdiag[row];
6896b95a6bSBarry Smith         PetscKernel_A_gets_A_times_B(bs, pc, pv, mwork);
699566063dSJacob Faibussowitsch         /* PetscCall(PetscKernel_A_gets_A_times_B_15(pc,pv,mwork)); */
70a5b23f4aSJose E. Roman         pj = b->j + bdiag[row + 1] + 1; /* beginning of U(row,:) */
712b0b2ea7SShri Abhyankar         pv = b->a + bs2 * (bdiag[row + 1] + 1);
722b0b2ea7SShri Abhyankar         nz = bdiag[row] - bdiag[row + 1] - 1; /* num of entries inU(row,:), excluding diag */
732b0b2ea7SShri Abhyankar         for (j = 0; j < nz; j++) {
74766f9fbaSBarry Smith           vv = rtmp + bs2 * pj[j];
7596b95a6bSBarry Smith           PetscKernel_A_gets_A_minus_B_times_C(bs, vv, pc, pv);
769566063dSJacob Faibussowitsch           /* PetscCall(PetscKernel_A_gets_A_minus_B_times_C_15(vv,pc,pv)); */
772b0b2ea7SShri Abhyankar           pv += bs2;
782b0b2ea7SShri Abhyankar         }
799566063dSJacob Faibussowitsch         PetscCall(PetscLogFlops(2.0 * bs2 * bs * (nz + 1) - bs2)); /* flops = 2*bs^3*nz + 2*bs^3 - bs2) */
802b0b2ea7SShri Abhyankar       }
812b0b2ea7SShri Abhyankar     }
822b0b2ea7SShri Abhyankar 
832b0b2ea7SShri Abhyankar     /* finished row so stick it into b->a */
842b0b2ea7SShri Abhyankar     /* L part */
852b0b2ea7SShri Abhyankar     pv = b->a + bs2 * bi[i];
862b0b2ea7SShri Abhyankar     pj = b->j + bi[i];
872b0b2ea7SShri Abhyankar     nz = bi[i + 1] - bi[i];
8848a46eb9SPierre Jolivet     for (j = 0; j < nz; j++) PetscCall(PetscArraycpy(pv + bs2 * j, rtmp + bs2 * pj[j], bs2));
892b0b2ea7SShri Abhyankar 
90a5b23f4aSJose E. Roman     /* Mark diagonal and invert diagonal for simpler triangular solves */
912b0b2ea7SShri Abhyankar     pv = b->a + bs2 * bdiag[i];
922b0b2ea7SShri Abhyankar     pj = b->j + bdiag[i];
939566063dSJacob Faibussowitsch     PetscCall(PetscArraycpy(pv, rtmp + bs2 * pj[0], bs2));
949566063dSJacob Faibussowitsch     PetscCall(PetscKernel_A_gets_inverse_A_15(pv, ipvt, work, info->shiftamount, allowzeropivot, &zeropivotdetected));
957b6c816cSBarry Smith     if (zeropivotdetected) C->factorerrortype = MAT_FACTOR_NUMERIC_ZEROPIVOT;
962b0b2ea7SShri Abhyankar 
972b0b2ea7SShri Abhyankar     /* U part */
982b0b2ea7SShri Abhyankar     pv = b->a + bs2 * (bdiag[i + 1] + 1);
992b0b2ea7SShri Abhyankar     pj = b->j + bdiag[i + 1] + 1;
1002b0b2ea7SShri Abhyankar     nz = bdiag[i] - bdiag[i + 1] - 1;
10148a46eb9SPierre Jolivet     for (j = 0; j < nz; j++) PetscCall(PetscArraycpy(pv + bs2 * j, rtmp + bs2 * pj[j], bs2));
1022b0b2ea7SShri Abhyankar   }
1032b0b2ea7SShri Abhyankar 
1049566063dSJacob Faibussowitsch   PetscCall(PetscFree2(rtmp, mwork));
10526fbe8dcSKarl Rupp 
106832cc040SShri Abhyankar   C->ops->solve          = MatSolve_SeqBAIJ_15_NaturalOrdering_ver1;
107766f9fbaSBarry Smith   C->ops->solvetranspose = MatSolve_SeqBAIJ_N_NaturalOrdering;
1082b0b2ea7SShri Abhyankar   C->assembled           = PETSC_TRUE;
10926fbe8dcSKarl Rupp 
1109566063dSJacob Faibussowitsch   PetscCall(PetscLogFlops(1.333333333333 * bs * bs2 * b->mbs)); /* from inverting diagonal blocks */
1113ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
1122b0b2ea7SShri Abhyankar }
1132b0b2ea7SShri Abhyankar 
MatLUFactorNumeric_SeqBAIJ_N(Mat B,Mat A,const MatFactorInfo * info)114d71ae5a4SJacob Faibussowitsch PetscErrorCode MatLUFactorNumeric_SeqBAIJ_N(Mat B, Mat A, const MatFactorInfo *info)
115d71ae5a4SJacob Faibussowitsch {
1166bce7ff8SHong Zhang   Mat             C = B;
1176bce7ff8SHong Zhang   Mat_SeqBAIJ    *a = (Mat_SeqBAIJ *)A->data, *b = (Mat_SeqBAIJ *)C->data;
1186bce7ff8SHong Zhang   IS              isrow = b->row, isicol = b->icol;
1195a586d82SBarry Smith   const PetscInt *r, *ic;
1206bce7ff8SHong Zhang   PetscInt        i, j, k, n = a->mbs, *ai = a->i, *aj = a->j, *bi = b->i, *bj = b->j;
1216bce7ff8SHong Zhang   PetscInt       *ajtmp, *bjtmp, nz, nzL, row, *bdiag = b->diag, *pj;
122b588c5a2SHong Zhang   MatScalar      *rtmp, *pc, *mwork, *v, *pv, *aa     = a->a;
123914a18a2SHong Zhang   PetscInt        bs = A->rmap->bs, bs2 = a->bs2, *v_pivots, flg;
124914a18a2SHong Zhang   MatScalar      *v_work;
125ace3abfcSBarry Smith   PetscBool       col_identity, row_identity, both_identity;
1265f8bbccaSHong Zhang   PetscBool       allowzeropivot, zeropivotdetected;
1276bce7ff8SHong Zhang 
1286bce7ff8SHong Zhang   PetscFunctionBegin;
1299566063dSJacob Faibussowitsch   PetscCall(ISGetIndices(isrow, &r));
1309566063dSJacob Faibussowitsch   PetscCall(ISGetIndices(isicol, &ic));
1315f8bbccaSHong Zhang   allowzeropivot = PetscNot(A->erroriffailure);
132ae3d28f0SHong Zhang 
1339566063dSJacob Faibussowitsch   PetscCall(PetscCalloc1(bs2 * n, &rtmp));
1346bce7ff8SHong Zhang 
135914a18a2SHong Zhang   /* generate work space needed by dense LU factorization */
1369566063dSJacob Faibussowitsch   PetscCall(PetscMalloc3(bs, &v_work, bs2, &mwork, bs, &v_pivots));
137914a18a2SHong Zhang 
1386bce7ff8SHong Zhang   for (i = 0; i < n; i++) {
1396bce7ff8SHong Zhang     /* zero rtmp */
1406bce7ff8SHong Zhang     /* L part */
1416bce7ff8SHong Zhang     nz    = bi[i + 1] - bi[i];
1426bce7ff8SHong Zhang     bjtmp = bj + bi[i];
14348a46eb9SPierre Jolivet     for (j = 0; j < nz; j++) PetscCall(PetscArrayzero(rtmp + bs2 * bjtmp[j], bs2));
1446bce7ff8SHong Zhang 
1456bce7ff8SHong Zhang     /* U part */
1461a83e813SShri Abhyankar     nz    = bdiag[i] - bdiag[i + 1];
1471a83e813SShri Abhyankar     bjtmp = bj + bdiag[i + 1] + 1;
14848a46eb9SPierre Jolivet     for (j = 0; j < nz; j++) PetscCall(PetscArrayzero(rtmp + bs2 * bjtmp[j], bs2));
1491a83e813SShri Abhyankar 
1501a83e813SShri Abhyankar     /* load in initial (unfactored row) */
1511a83e813SShri Abhyankar     nz    = ai[r[i] + 1] - ai[r[i]];
1521a83e813SShri Abhyankar     ajtmp = aj + ai[r[i]];
1531a83e813SShri Abhyankar     v     = aa + bs2 * ai[r[i]];
15448a46eb9SPierre Jolivet     for (j = 0; j < nz; j++) PetscCall(PetscArraycpy(rtmp + bs2 * ic[ajtmp[j]], v + bs2 * j, bs2));
1551a83e813SShri Abhyankar 
1561a83e813SShri Abhyankar     /* elimination */
1571a83e813SShri Abhyankar     bjtmp = bj + bi[i];
1581a83e813SShri Abhyankar     nzL   = bi[i + 1] - bi[i];
1591a83e813SShri Abhyankar     for (k = 0; k < nzL; k++) {
1601a83e813SShri Abhyankar       row = bjtmp[k];
1611a83e813SShri Abhyankar       pc  = rtmp + bs2 * row;
162c35f09e5SBarry Smith       for (flg = 0, j = 0; j < bs2; j++) {
163c35f09e5SBarry Smith         if (pc[j] != 0.0) {
164c35f09e5SBarry Smith           flg = 1;
165c35f09e5SBarry Smith           break;
166c35f09e5SBarry Smith         }
167c35f09e5SBarry Smith       }
1681a83e813SShri Abhyankar       if (flg) {
1691a83e813SShri Abhyankar         pv = b->a + bs2 * bdiag[row];
17096b95a6bSBarry Smith         PetscKernel_A_gets_A_times_B(bs, pc, pv, mwork); /* *pc = *pc * (*pv); */
171a5b23f4aSJose E. Roman         pj = b->j + bdiag[row + 1] + 1;                  /* beginning of U(row,:) */
1721a83e813SShri Abhyankar         pv = b->a + bs2 * (bdiag[row + 1] + 1);
1731a83e813SShri Abhyankar         nz = bdiag[row] - bdiag[row + 1] - 1; /* num of entries inU(row,:), excluding diag */
174ad540459SPierre Jolivet         for (j = 0; j < nz; j++) PetscKernel_A_gets_A_minus_B_times_C(bs, rtmp + bs2 * pj[j], pc, pv + bs2 * j);
1759566063dSJacob Faibussowitsch         PetscCall(PetscLogFlops(2.0 * bs2 * bs * (nz + 1) - bs2)); /* flops = 2*bs^3*nz + 2*bs^3 - bs2) */
1761a83e813SShri Abhyankar       }
1771a83e813SShri Abhyankar     }
1781a83e813SShri Abhyankar 
1791a83e813SShri Abhyankar     /* finished row so stick it into b->a */
1801a83e813SShri Abhyankar     /* L part */
1811a83e813SShri Abhyankar     pv = b->a + bs2 * bi[i];
1821a83e813SShri Abhyankar     pj = b->j + bi[i];
1831a83e813SShri Abhyankar     nz = bi[i + 1] - bi[i];
18448a46eb9SPierre Jolivet     for (j = 0; j < nz; j++) PetscCall(PetscArraycpy(pv + bs2 * j, rtmp + bs2 * pj[j], bs2));
1851a83e813SShri Abhyankar 
186a5b23f4aSJose E. Roman     /* Mark diagonal and invert diagonal for simpler triangular solves */
1871a83e813SShri Abhyankar     pv = b->a + bs2 * bdiag[i];
1881a83e813SShri Abhyankar     pj = b->j + bdiag[i];
1899566063dSJacob Faibussowitsch     PetscCall(PetscArraycpy(pv, rtmp + bs2 * pj[0], bs2));
1905f8bbccaSHong Zhang 
1919566063dSJacob Faibussowitsch     PetscCall(PetscKernel_A_gets_inverse_A(bs, pv, v_pivots, v_work, allowzeropivot, &zeropivotdetected));
1927b6c816cSBarry Smith     if (zeropivotdetected) B->factorerrortype = MAT_FACTOR_NUMERIC_ZEROPIVOT;
1931a83e813SShri Abhyankar 
1941a83e813SShri Abhyankar     /* U part */
1951a83e813SShri Abhyankar     pv = b->a + bs2 * (bdiag[i + 1] + 1);
1961a83e813SShri Abhyankar     pj = b->j + bdiag[i + 1] + 1;
1971a83e813SShri Abhyankar     nz = bdiag[i] - bdiag[i + 1] - 1;
19848a46eb9SPierre Jolivet     for (j = 0; j < nz; j++) PetscCall(PetscArraycpy(pv + bs2 * j, rtmp + bs2 * pj[j], bs2));
1991a83e813SShri Abhyankar   }
2001a83e813SShri Abhyankar 
2019566063dSJacob Faibussowitsch   PetscCall(PetscFree(rtmp));
2029566063dSJacob Faibussowitsch   PetscCall(PetscFree3(v_work, mwork, v_pivots));
2039566063dSJacob Faibussowitsch   PetscCall(ISRestoreIndices(isicol, &ic));
2049566063dSJacob Faibussowitsch   PetscCall(ISRestoreIndices(isrow, &r));
2051a83e813SShri Abhyankar 
2069566063dSJacob Faibussowitsch   PetscCall(ISIdentity(isrow, &row_identity));
2079566063dSJacob Faibussowitsch   PetscCall(ISIdentity(isicol, &col_identity));
20826fbe8dcSKarl Rupp 
209ace3abfcSBarry Smith   both_identity = (PetscBool)(row_identity && col_identity);
210ae3d28f0SHong Zhang   if (both_identity) {
211ba7f0461SHong Zhang     switch (bs) {
21296e086a2SDaniel Kokron     case 9:
2135f70456aSHong Zhang #if defined(PETSC_HAVE_IMMINTRIN_H) && defined(__AVX2__) && defined(__FMA__) && defined(PETSC_USE_REAL_DOUBLE) && !defined(PETSC_USE_COMPLEX) && !defined(PETSC_USE_64BIT_INDICES)
21496e086a2SDaniel Kokron       C->ops->solve = MatSolve_SeqBAIJ_9_NaturalOrdering;
215aee5c371SBarry Smith #else
216aee5c371SBarry Smith       C->ops->solve = MatSolve_SeqBAIJ_N_NaturalOrdering;
217aee5c371SBarry Smith #endif
21896e086a2SDaniel Kokron       break;
219d71ae5a4SJacob Faibussowitsch     case 11:
220d71ae5a4SJacob Faibussowitsch       C->ops->solve = MatSolve_SeqBAIJ_11_NaturalOrdering;
221d71ae5a4SJacob Faibussowitsch       break;
222d71ae5a4SJacob Faibussowitsch     case 12:
223d71ae5a4SJacob Faibussowitsch       C->ops->solve = MatSolve_SeqBAIJ_12_NaturalOrdering;
224d71ae5a4SJacob Faibussowitsch       break;
225d71ae5a4SJacob Faibussowitsch     case 13:
226d71ae5a4SJacob Faibussowitsch       C->ops->solve = MatSolve_SeqBAIJ_13_NaturalOrdering;
227d71ae5a4SJacob Faibussowitsch       break;
228d71ae5a4SJacob Faibussowitsch     case 14:
229d71ae5a4SJacob Faibussowitsch       C->ops->solve = MatSolve_SeqBAIJ_14_NaturalOrdering;
230d71ae5a4SJacob Faibussowitsch       break;
231d71ae5a4SJacob Faibussowitsch     default:
232d71ae5a4SJacob Faibussowitsch       C->ops->solve = MatSolve_SeqBAIJ_N_NaturalOrdering;
233d71ae5a4SJacob Faibussowitsch       break;
234ba7f0461SHong Zhang     }
235ae3d28f0SHong Zhang   } else {
2364dd39f65SShri Abhyankar     C->ops->solve = MatSolve_SeqBAIJ_N;
237ae3d28f0SHong Zhang   }
2384dd39f65SShri Abhyankar   C->ops->solvetranspose = MatSolveTranspose_SeqBAIJ_N;
239ae3d28f0SHong Zhang 
2401a83e813SShri Abhyankar   C->assembled = PETSC_TRUE;
24126fbe8dcSKarl Rupp 
2429566063dSJacob Faibussowitsch   PetscCall(PetscLogFlops(1.333333333333 * bs * bs2 * b->mbs)); /* from inverting diagonal blocks */
2433ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
2441a83e813SShri Abhyankar }
2451a83e813SShri Abhyankar 
2466bce7ff8SHong Zhang /*
2476bce7ff8SHong Zhang    ilu(0) with natural ordering under new data structure.
2484dd39f65SShri Abhyankar    See MatILUFactorSymbolic_SeqAIJ_ilu0() for detailed description
2494dd39f65SShri Abhyankar    because this code is almost identical to MatILUFactorSymbolic_SeqAIJ_ilu0_inplace().
2506bce7ff8SHong Zhang */
251c0c7eb62SShri Abhyankar 
MatILUFactorSymbolic_SeqBAIJ_ilu0(Mat fact,Mat A,IS isrow,IS iscol,const MatFactorInfo * info)25266976f2fSJacob Faibussowitsch static PetscErrorCode MatILUFactorSymbolic_SeqBAIJ_ilu0(Mat fact, Mat A, IS isrow, IS iscol, const MatFactorInfo *info)
253d71ae5a4SJacob Faibussowitsch {
2546bce7ff8SHong Zhang   Mat_SeqBAIJ   *a = (Mat_SeqBAIJ *)A->data, *b;
255*421480d9SBarry Smith   const PetscInt n = a->mbs, *ai = a->i, *aj, *adiag, bs2 = a->bs2;
25635aa4fcfSShri Abhyankar   PetscInt       i, j, nz, *bi, *bj, *bdiag, bi_temp;
25735aa4fcfSShri Abhyankar 
25835aa4fcfSShri Abhyankar   PetscFunctionBegin;
259*421480d9SBarry Smith   PetscCall(MatGetDiagonalMarkers_SeqBAIJ(A, &adiag, NULL));
2609566063dSJacob Faibussowitsch   PetscCall(MatDuplicateNoCreate_SeqBAIJ(fact, A, MAT_DO_NOT_COPY_VALUES, PETSC_FALSE));
26157508eceSPierre Jolivet   b = (Mat_SeqBAIJ *)fact->data;
26235aa4fcfSShri Abhyankar 
26335aa4fcfSShri Abhyankar   /* allocate matrix arrays for new data structure */
26484648c2dSPierre Jolivet   PetscCall(PetscShmgetAllocateArray(bs2 * ai[n], sizeof(PetscScalar), (void **)&b->a));
26584648c2dSPierre Jolivet   PetscCall(PetscShmgetAllocateArray(ai[n], sizeof(PetscInt), (void **)&b->j));
2669f0612e4SBarry Smith   PetscCall(PetscShmgetAllocateArray(n + 1, sizeof(PetscInt), (void **)&b->i));
267379be0ddSLisandro Dalcin   b->free_a          = PETSC_TRUE;
268379be0ddSLisandro Dalcin   b->free_ij         = PETSC_TRUE;
2691e40a84eSLisandro Dalcin   fact->preallocated = PETSC_TRUE;
2701e40a84eSLisandro Dalcin   fact->assembled    = PETSC_TRUE;
271aa624791SPierre Jolivet   if (!b->diag) PetscCall(PetscMalloc1(n + 1, &b->diag));
27235aa4fcfSShri Abhyankar   bdiag = b->diag;
27335aa4fcfSShri Abhyankar 
27448a46eb9SPierre Jolivet   if (n > 0) PetscCall(PetscArrayzero(b->a, bs2 * ai[n]));
27535aa4fcfSShri Abhyankar 
27635aa4fcfSShri Abhyankar   /* set bi and bj with new data structure */
27735aa4fcfSShri Abhyankar   bi = b->i;
27835aa4fcfSShri Abhyankar   bj = b->j;
27935aa4fcfSShri Abhyankar 
28035aa4fcfSShri Abhyankar   /* L part */
28135aa4fcfSShri Abhyankar   bi[0] = 0;
28235aa4fcfSShri Abhyankar   for (i = 0; i < n; i++) {
28335aa4fcfSShri Abhyankar     nz        = adiag[i] - ai[i];
28435aa4fcfSShri Abhyankar     bi[i + 1] = bi[i] + nz;
28535aa4fcfSShri Abhyankar     aj        = a->j + ai[i];
28635aa4fcfSShri Abhyankar     for (j = 0; j < nz; j++) {
2879371c9d4SSatish Balay       *bj = aj[j];
2889371c9d4SSatish Balay       bj++;
28935aa4fcfSShri Abhyankar     }
29035aa4fcfSShri Abhyankar   }
29135aa4fcfSShri Abhyankar 
29235aa4fcfSShri Abhyankar   /* U part */
29335aa4fcfSShri Abhyankar   bi_temp  = bi[n];
29435aa4fcfSShri Abhyankar   bdiag[n] = bi[n] - 1;
29535aa4fcfSShri Abhyankar   for (i = n - 1; i >= 0; i--) {
29635aa4fcfSShri Abhyankar     nz      = ai[i + 1] - adiag[i] - 1;
29735aa4fcfSShri Abhyankar     bi_temp = bi_temp + nz + 1;
29835aa4fcfSShri Abhyankar     aj      = a->j + adiag[i] + 1;
29935aa4fcfSShri Abhyankar     for (j = 0; j < nz; j++) {
3009371c9d4SSatish Balay       *bj = aj[j];
3019371c9d4SSatish Balay       bj++;
30235aa4fcfSShri Abhyankar     }
30335aa4fcfSShri Abhyankar     /* diag[i] */
3049371c9d4SSatish Balay     *bj = i;
3059371c9d4SSatish Balay     bj++;
30635aa4fcfSShri Abhyankar     bdiag[i] = bi_temp - 1;
30735aa4fcfSShri Abhyankar   }
3083ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
30935aa4fcfSShri Abhyankar }
31035aa4fcfSShri Abhyankar 
MatILUFactorSymbolic_SeqBAIJ(Mat fact,Mat A,IS isrow,IS iscol,const MatFactorInfo * info)311d71ae5a4SJacob Faibussowitsch PetscErrorCode MatILUFactorSymbolic_SeqBAIJ(Mat fact, Mat A, IS isrow, IS iscol, const MatFactorInfo *info)
312d71ae5a4SJacob Faibussowitsch {
31316a2bf60SHong Zhang   Mat_SeqBAIJ       *a = (Mat_SeqBAIJ *)A->data, *b;
31416a2bf60SHong Zhang   IS                 isicol;
31516a2bf60SHong Zhang   const PetscInt    *r, *ic;
316*421480d9SBarry Smith   PetscInt           n = a->mbs, *ai = a->i, *aj = a->j;
31716a2bf60SHong Zhang   PetscInt          *bi, *cols, nnz, *cols_lvl;
31816a2bf60SHong Zhang   PetscInt          *bdiag, prow, fm, nzbd, reallocs = 0, dcount = 0;
31916a2bf60SHong Zhang   PetscInt           i, levels, diagonal_fill;
320ace3abfcSBarry Smith   PetscBool          col_identity, row_identity, both_identity;
32116a2bf60SHong Zhang   PetscReal          f;
3220298fd71SBarry Smith   PetscInt           nlnk, *lnk, *lnk_lvl = NULL;
32316a2bf60SHong Zhang   PetscBT            lnkbt;
32416a2bf60SHong Zhang   PetscInt           nzi, *bj, **bj_ptr, **bjlvl_ptr;
3250298fd71SBarry Smith   PetscFreeSpaceList free_space = NULL, current_space = NULL;
3260298fd71SBarry Smith   PetscFreeSpaceList free_space_lvl = NULL, current_space_lvl = NULL;
3277fa3a6a0SHong Zhang   PetscInt           bs = A->rmap->bs, bs2 = a->bs2;
328*421480d9SBarry Smith   PetscBool          diagDense;
32916a2bf60SHong Zhang 
33016a2bf60SHong Zhang   PetscFunctionBegin;
33108401ef6SPierre Jolivet   PetscCheck(A->rmap->n == A->cmap->n, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONG, "Must be square matrix, rows %" PetscInt_FMT " columns %" PetscInt_FMT, A->rmap->n, A->cmap->n);
3326ba06ab7SHong Zhang   if (bs > 1) { /* check shifttype */
33313bcc0bdSJacob Faibussowitsch     PetscCheck(info->shifttype != (PetscReal)MAT_SHIFT_NONZERO && info->shifttype != (PetscReal)MAT_SHIFT_POSITIVE_DEFINITE, PETSC_COMM_SELF, PETSC_ERR_SUP, "Only MAT_SHIFT_NONE and MAT_SHIFT_INBLOCKS are supported for BAIJ matrix");
3346ba06ab7SHong Zhang   }
335*421480d9SBarry Smith   PetscCall(MatGetDiagonalMarkers_SeqBAIJ(A, NULL, &diagDense));
336*421480d9SBarry Smith   PetscCheck(diagDense, PETSC_COMM_SELF, PETSC_ERR_ARG_WRONGSTATE, "Matrix is missing diagonal entry");
33716a2bf60SHong Zhang 
33816a2bf60SHong Zhang   f             = info->fill;
33916a2bf60SHong Zhang   levels        = (PetscInt)info->levels;
34016a2bf60SHong Zhang   diagonal_fill = (PetscInt)info->diagonal_fill;
34126fbe8dcSKarl Rupp 
3429566063dSJacob Faibussowitsch   PetscCall(ISInvertPermutation(iscol, PETSC_DECIDE, &isicol));
34316a2bf60SHong Zhang 
3449566063dSJacob Faibussowitsch   PetscCall(ISIdentity(isrow, &row_identity));
3459566063dSJacob Faibussowitsch   PetscCall(ISIdentity(iscol, &col_identity));
34626fbe8dcSKarl Rupp 
347ace3abfcSBarry Smith   both_identity = (PetscBool)(row_identity && col_identity);
34816a2bf60SHong Zhang 
3497fa3a6a0SHong Zhang   if (!levels && both_identity) {
35016a2bf60SHong Zhang     /* special case: ilu(0) with natural ordering */
3519566063dSJacob Faibussowitsch     PetscCall(MatILUFactorSymbolic_SeqBAIJ_ilu0(fact, A, isrow, iscol, info));
3529566063dSJacob Faibussowitsch     PetscCall(MatSeqBAIJSetNumericFactorization(fact, both_identity));
35335aa4fcfSShri Abhyankar 
354d5f3da31SBarry Smith     fact->factortype             = MAT_FACTOR_ILU;
35557508eceSPierre Jolivet     fact->info.factor_mallocs    = 0;
35657508eceSPierre Jolivet     fact->info.fill_ratio_given  = info->fill;
35757508eceSPierre Jolivet     fact->info.fill_ratio_needed = 1.0;
35826fbe8dcSKarl Rupp 
35957508eceSPierre Jolivet     b       = (Mat_SeqBAIJ *)fact->data;
36035aa4fcfSShri Abhyankar     b->row  = isrow;
36135aa4fcfSShri Abhyankar     b->col  = iscol;
36235aa4fcfSShri Abhyankar     b->icol = isicol;
3639566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject)isrow));
3649566063dSJacob Faibussowitsch     PetscCall(PetscObjectReference((PetscObject)iscol));
36535aa4fcfSShri Abhyankar     b->pivotinblocks = (info->pivotinblocks) ? PETSC_TRUE : PETSC_FALSE;
36626fbe8dcSKarl Rupp 
3679566063dSJacob Faibussowitsch     PetscCall(PetscMalloc1((n + 1) * bs, &b->solve_work));
3683ba16761SJacob Faibussowitsch     PetscFunctionReturn(PETSC_SUCCESS);
36935aa4fcfSShri Abhyankar   }
37035aa4fcfSShri Abhyankar 
3719566063dSJacob Faibussowitsch   PetscCall(ISGetIndices(isrow, &r));
3729566063dSJacob Faibussowitsch   PetscCall(ISGetIndices(isicol, &ic));
37335aa4fcfSShri Abhyankar 
37435aa4fcfSShri Abhyankar   /* get new row pointers */
3759566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(n + 1, &bi));
37635aa4fcfSShri Abhyankar   bi[0] = 0;
37735aa4fcfSShri Abhyankar   /* bdiag is location of diagonal in factor */
3789566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(n + 1, &bdiag));
37935aa4fcfSShri Abhyankar   bdiag[0] = 0;
38035aa4fcfSShri Abhyankar 
3819566063dSJacob Faibussowitsch   PetscCall(PetscMalloc2(n, &bj_ptr, n, &bjlvl_ptr));
38235aa4fcfSShri Abhyankar 
38335aa4fcfSShri Abhyankar   /* create a linked list for storing column indices of the active row */
38435aa4fcfSShri Abhyankar   nlnk = n + 1;
3859566063dSJacob Faibussowitsch   PetscCall(PetscIncompleteLLCreate(n, n, nlnk, lnk, lnk_lvl, lnkbt));
38635aa4fcfSShri Abhyankar 
38735aa4fcfSShri Abhyankar   /* initial FreeSpace size is f*(ai[n]+1) */
3889566063dSJacob Faibussowitsch   PetscCall(PetscFreeSpaceGet(PetscRealIntMultTruncate(f, ai[n] + 1), &free_space));
38935aa4fcfSShri Abhyankar   current_space = free_space;
3909566063dSJacob Faibussowitsch   PetscCall(PetscFreeSpaceGet(PetscRealIntMultTruncate(f, ai[n] + 1), &free_space_lvl));
39135aa4fcfSShri Abhyankar   current_space_lvl = free_space_lvl;
39235aa4fcfSShri Abhyankar 
39335aa4fcfSShri Abhyankar   for (i = 0; i < n; i++) {
39435aa4fcfSShri Abhyankar     nzi = 0;
39535aa4fcfSShri Abhyankar     /* copy current row into linked list */
39635aa4fcfSShri Abhyankar     nnz = ai[r[i] + 1] - ai[r[i]];
39794bad497SJacob Faibussowitsch     PetscCheck(nnz, PETSC_COMM_SELF, PETSC_ERR_MAT_LU_ZRPVT, "Empty row in matrix: row in original ordering %" PetscInt_FMT " in permuted ordering %" PetscInt_FMT, r[i], i);
39835aa4fcfSShri Abhyankar     cols   = aj + ai[r[i]];
39935aa4fcfSShri Abhyankar     lnk[i] = -1; /* marker to indicate if diagonal exists */
4009566063dSJacob Faibussowitsch     PetscCall(PetscIncompleteLLInit(nnz, cols, n, ic, &nlnk, lnk, lnk_lvl, lnkbt));
40135aa4fcfSShri Abhyankar     nzi += nlnk;
40235aa4fcfSShri Abhyankar 
40335aa4fcfSShri Abhyankar     /* make sure diagonal entry is included */
40435aa4fcfSShri Abhyankar     if (diagonal_fill && lnk[i] == -1) {
40535aa4fcfSShri Abhyankar       fm = n;
40635aa4fcfSShri Abhyankar       while (lnk[fm] < i) fm = lnk[fm];
40735aa4fcfSShri Abhyankar       lnk[i]     = lnk[fm]; /* insert diagonal into linked list */
40835aa4fcfSShri Abhyankar       lnk[fm]    = i;
40935aa4fcfSShri Abhyankar       lnk_lvl[i] = 0;
4109371c9d4SSatish Balay       nzi++;
4119371c9d4SSatish Balay       dcount++;
41235aa4fcfSShri Abhyankar     }
41335aa4fcfSShri Abhyankar 
41435aa4fcfSShri Abhyankar     /* add pivot rows into the active row */
41535aa4fcfSShri Abhyankar     nzbd = 0;
41635aa4fcfSShri Abhyankar     prow = lnk[n];
41735aa4fcfSShri Abhyankar     while (prow < i) {
41835aa4fcfSShri Abhyankar       nnz      = bdiag[prow];
41935aa4fcfSShri Abhyankar       cols     = bj_ptr[prow] + nnz + 1;
42035aa4fcfSShri Abhyankar       cols_lvl = bjlvl_ptr[prow] + nnz + 1;
42135aa4fcfSShri Abhyankar       nnz      = bi[prow + 1] - bi[prow] - nnz - 1;
42226fbe8dcSKarl Rupp 
4239566063dSJacob Faibussowitsch       PetscCall(PetscILULLAddSorted(nnz, cols, levels, cols_lvl, prow, &nlnk, lnk, lnk_lvl, lnkbt, prow));
42435aa4fcfSShri Abhyankar       nzi += nlnk;
42535aa4fcfSShri Abhyankar       prow = lnk[prow];
42635aa4fcfSShri Abhyankar       nzbd++;
42735aa4fcfSShri Abhyankar     }
42835aa4fcfSShri Abhyankar     bdiag[i]  = nzbd;
42935aa4fcfSShri Abhyankar     bi[i + 1] = bi[i] + nzi;
43035aa4fcfSShri Abhyankar 
43135aa4fcfSShri Abhyankar     /* if free space is not available, make more free space */
43235aa4fcfSShri Abhyankar     if (current_space->local_remaining < nzi) {
43357508eceSPierre Jolivet       nnz = PetscIntMultTruncate(2, PetscIntMultTruncate(nzi, n - i)); /* estimated and max additional space needed */
4349566063dSJacob Faibussowitsch       PetscCall(PetscFreeSpaceGet(nnz, &current_space));
4359566063dSJacob Faibussowitsch       PetscCall(PetscFreeSpaceGet(nnz, &current_space_lvl));
43635aa4fcfSShri Abhyankar       reallocs++;
43735aa4fcfSShri Abhyankar     }
43835aa4fcfSShri Abhyankar 
43935aa4fcfSShri Abhyankar     /* copy data into free_space and free_space_lvl, then initialize lnk */
4409566063dSJacob Faibussowitsch     PetscCall(PetscIncompleteLLClean(n, n, nzi, lnk, lnk_lvl, current_space->array, current_space_lvl->array, lnkbt));
44126fbe8dcSKarl Rupp 
44235aa4fcfSShri Abhyankar     bj_ptr[i]    = current_space->array;
44335aa4fcfSShri Abhyankar     bjlvl_ptr[i] = current_space_lvl->array;
44435aa4fcfSShri Abhyankar 
44535aa4fcfSShri Abhyankar     /* make sure the active row i has diagonal entry */
44600045ab3SPierre Jolivet     PetscCheck(*(bj_ptr[i] + bdiag[i]) == i, PETSC_COMM_SELF, PETSC_ERR_MAT_LU_ZRPVT, "Row %" PetscInt_FMT " has missing diagonal in factored matrix, try running with -pc_factor_nonzeros_along_diagonal or -pc_factor_diagonal_fill", i);
44735aa4fcfSShri Abhyankar 
44835aa4fcfSShri Abhyankar     current_space->array += nzi;
44935aa4fcfSShri Abhyankar     current_space->local_used += nzi;
45035aa4fcfSShri Abhyankar     current_space->local_remaining -= nzi;
45126fbe8dcSKarl Rupp 
45235aa4fcfSShri Abhyankar     current_space_lvl->array += nzi;
45335aa4fcfSShri Abhyankar     current_space_lvl->local_used += nzi;
45435aa4fcfSShri Abhyankar     current_space_lvl->local_remaining -= nzi;
45535aa4fcfSShri Abhyankar   }
45635aa4fcfSShri Abhyankar 
4579566063dSJacob Faibussowitsch   PetscCall(ISRestoreIndices(isrow, &r));
4589566063dSJacob Faibussowitsch   PetscCall(ISRestoreIndices(isicol, &ic));
45935aa4fcfSShri Abhyankar 
46035aa4fcfSShri Abhyankar   /* copy free_space into bj and free free_space; set bi, bj, bdiag in new datastructure; */
46184648c2dSPierre Jolivet   PetscCall(PetscMalloc1(bi[n], &bj));
4629566063dSJacob Faibussowitsch   PetscCall(PetscFreeSpaceContiguous_LU(&free_space, bj, n, bi, bdiag));
46335aa4fcfSShri Abhyankar 
4649566063dSJacob Faibussowitsch   PetscCall(PetscIncompleteLLDestroy(lnk, lnkbt));
4659566063dSJacob Faibussowitsch   PetscCall(PetscFreeSpaceDestroy(free_space_lvl));
4669566063dSJacob Faibussowitsch   PetscCall(PetscFree2(bj_ptr, bjlvl_ptr));
46735aa4fcfSShri Abhyankar 
46835aa4fcfSShri Abhyankar #if defined(PETSC_USE_INFO)
46935aa4fcfSShri Abhyankar   {
470aef85c9fSShri Abhyankar     PetscReal af = ((PetscReal)(bdiag[0] + 1)) / ((PetscReal)ai[n]);
4719566063dSJacob Faibussowitsch     PetscCall(PetscInfo(A, "Reallocs %" PetscInt_FMT " Fill ratio:given %g needed %g\n", reallocs, (double)f, (double)af));
4729566063dSJacob Faibussowitsch     PetscCall(PetscInfo(A, "Run with -[sub_]pc_factor_fill %g or use \n", (double)af));
4739566063dSJacob Faibussowitsch     PetscCall(PetscInfo(A, "PCFactorSetFill([sub]pc,%g);\n", (double)af));
4749566063dSJacob Faibussowitsch     PetscCall(PetscInfo(A, "for best performance.\n"));
47548a46eb9SPierre Jolivet     if (diagonal_fill) PetscCall(PetscInfo(A, "Detected and replaced %" PetscInt_FMT " missing diagonals\n", dcount));
47635aa4fcfSShri Abhyankar   }
47735aa4fcfSShri Abhyankar #endif
47835aa4fcfSShri Abhyankar 
47935aa4fcfSShri Abhyankar   /* put together the new matrix */
4809566063dSJacob Faibussowitsch   PetscCall(MatSeqBAIJSetPreallocation(fact, bs, MAT_SKIP_ALLOCATION, NULL));
48126fbe8dcSKarl Rupp 
48257508eceSPierre Jolivet   b          = (Mat_SeqBAIJ *)fact->data;
48335aa4fcfSShri Abhyankar   b->free_ij = PETSC_TRUE;
4849f0612e4SBarry Smith   PetscCall(PetscShmgetAllocateArray(bs2 * (bdiag[0] + 1), sizeof(PetscScalar), (void **)&b->a));
4859f0612e4SBarry Smith   b->free_a = PETSC_TRUE;
48626fbe8dcSKarl Rupp 
48735aa4fcfSShri Abhyankar   b->j    = bj;
48835aa4fcfSShri Abhyankar   b->i    = bi;
48935aa4fcfSShri Abhyankar   b->diag = bdiag;
490f4259b30SLisandro Dalcin   b->ilen = NULL;
491f4259b30SLisandro Dalcin   b->imax = NULL;
49235aa4fcfSShri Abhyankar   b->row  = isrow;
49335aa4fcfSShri Abhyankar   b->col  = iscol;
4949566063dSJacob Faibussowitsch   PetscCall(PetscObjectReference((PetscObject)isrow));
4959566063dSJacob Faibussowitsch   PetscCall(PetscObjectReference((PetscObject)iscol));
49635aa4fcfSShri Abhyankar   b->icol = isicol;
49726fbe8dcSKarl Rupp 
4989566063dSJacob Faibussowitsch   PetscCall(PetscMalloc1(bs * n + bs, &b->solve_work));
49935aa4fcfSShri Abhyankar   /* In b structure:  Free imax, ilen, old a, old j.
50035aa4fcfSShri Abhyankar      Allocate bdiag, solve_work, new a, new j */
50135aa4fcfSShri Abhyankar   b->maxnz = b->nz = bdiag[0] + 1;
50226fbe8dcSKarl Rupp 
503ae3d28f0SHong Zhang   fact->info.factor_mallocs    = reallocs;
504ae3d28f0SHong Zhang   fact->info.fill_ratio_given  = f;
505ae3d28f0SHong Zhang   fact->info.fill_ratio_needed = ((PetscReal)(bdiag[0] + 1)) / ((PetscReal)ai[n]);
50626fbe8dcSKarl Rupp 
5079566063dSJacob Faibussowitsch   PetscCall(MatSeqBAIJSetNumericFactorization(fact, both_identity));
5083ba16761SJacob Faibussowitsch   PetscFunctionReturn(PETSC_SUCCESS);
50935aa4fcfSShri Abhyankar }
510