xref: /petsc/src/mat/impls/baij/seq/dgefa.c (revision 96b95a6bf9ed541503cb02ce9899069044d5ddfa)
1be1d678aSKris Buschelman 
2a97b7df5SSatish Balay /*
39fd41dd0SBarry Smith        This routine was converted by f2c from Linpack source
49fd41dd0SBarry Smith              linpack. this version dated 08/14/78
59fd41dd0SBarry Smith       cleve moler, university of new mexico, argonne national lab.
659539b86SBarry Smith 
759539b86SBarry Smith         Does an LU factorization with partial pivoting of a dense
89d8b60e5SBarry Smith      n by n matrix.
99d8b60e5SBarry Smith 
109d8b60e5SBarry Smith        Used by the sparse factorization routines in
11dd882469SBarry Smith      src/mat/impls/baij/seq
1259539b86SBarry Smith 
139fd41dd0SBarry Smith */
14c6db04a5SJed Brown #include <petscsys.h>
159fd41dd0SBarry Smith 
164a2ae208SSatish Balay #undef __FUNCT__
17*96b95a6bSBarry Smith #define __FUNCT__ "PetscLINPACKgefa"
18*96b95a6bSBarry Smith PetscErrorCode PetscLINPACKgefa(MatScalar *a,PetscInt n,PetscInt *ipvt)
199fd41dd0SBarry Smith {
20690b6cddSBarry Smith     PetscInt   i__2,i__3,kp1,nm1,j,k,l,ll,kn,knp1,jn1;
213f1db9ecSBarry Smith     MatScalar  t,*ax,*ay,*aa;
22329f5518SBarry Smith     MatReal    tmp,max;
239fd41dd0SBarry Smith 
249fd41dd0SBarry Smith /*     gaussian elimination with partial pivoting */
259fd41dd0SBarry Smith 
263a40ed3dSBarry Smith     PetscFunctionBegin;
279fd41dd0SBarry Smith     /* Parameter adjustments */
289fd41dd0SBarry Smith     --ipvt;
2939d66777SBarry Smith     a       -= n + 1;
309fd41dd0SBarry Smith 
319fd41dd0SBarry Smith     /* Function Body */
329fd41dd0SBarry Smith     nm1 = n - 1;
3339d66777SBarry Smith     for (k = 1; k <= nm1; ++k) {
349fd41dd0SBarry Smith 	kp1  = k + 1;
3539d66777SBarry Smith         kn   = k*n;
3639d66777SBarry Smith         knp1 = k*n + k;
379fd41dd0SBarry Smith 
389fd41dd0SBarry Smith /*        find l = pivot index */
399fd41dd0SBarry Smith 
409fd41dd0SBarry Smith 	i__2 = n - k + 1;
4139d66777SBarry Smith         aa = &a[knp1];
429fd41dd0SBarry Smith         max = PetscAbsScalar(aa[0]);
439fd41dd0SBarry Smith         l = 1;
449fd41dd0SBarry Smith         for (ll=1; ll<i__2; ll++) {
459fd41dd0SBarry Smith           tmp = PetscAbsScalar(aa[ll]);
469fd41dd0SBarry Smith           if (tmp > max) { max = tmp; l = ll+1;}
479fd41dd0SBarry Smith         }
489fd41dd0SBarry Smith         l += k - 1;
499fd41dd0SBarry Smith 	ipvt[k] = l;
509fd41dd0SBarry Smith 
5165e19b50SBarry Smith 	if (a[l + kn] == 0.0) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_MAT_LU_ZRPVT,"Zero pivot, row %D",k-1);
529fd41dd0SBarry Smith 
539fd41dd0SBarry Smith /*           interchange if necessary */
549fd41dd0SBarry Smith 
559fd41dd0SBarry Smith 	if (l != k) {
5639d66777SBarry Smith 	  t = a[l + kn];
5739d66777SBarry Smith 	  a[l + kn] = a[knp1];
5839d66777SBarry Smith 	  a[knp1] = t;
599fd41dd0SBarry Smith         }
609fd41dd0SBarry Smith 
619fd41dd0SBarry Smith /*           compute multipliers */
629fd41dd0SBarry Smith 
6339d66777SBarry Smith 	t = -1. / a[knp1];
649fd41dd0SBarry Smith 	i__2 = n - k;
6539d66777SBarry Smith         aa = &a[1 + knp1];
669fd41dd0SBarry Smith         for (ll=0; ll<i__2; ll++) {
679fd41dd0SBarry Smith           aa[ll] *= t;
689fd41dd0SBarry Smith         }
699fd41dd0SBarry Smith 
709fd41dd0SBarry Smith /*           row elimination with column indexing */
719fd41dd0SBarry Smith 
7239d66777SBarry Smith 	ax = aa;
739fd41dd0SBarry Smith         for (j = kp1; j <= n; ++j) {
748d3e6ddaSBarry Smith             jn1 = j*n;
758d3e6ddaSBarry Smith 	    t = a[l + jn1];
769fd41dd0SBarry Smith 	    if (l != k) {
778d3e6ddaSBarry Smith 	      a[l + jn1] = a[k + jn1];
788d3e6ddaSBarry Smith 	      a[k + jn1] = t;
799fd41dd0SBarry Smith             }
809fd41dd0SBarry Smith 
819fd41dd0SBarry Smith 	    i__3 = n - k;
828d3e6ddaSBarry Smith             ay = &a[1+k+jn1];
839fd41dd0SBarry Smith             for (ll=0; ll<i__3; ll++) {
849fd41dd0SBarry Smith               ay[ll] += t*ax[ll];
859fd41dd0SBarry Smith             }
869fd41dd0SBarry Smith 	}
879fd41dd0SBarry Smith     }
889fd41dd0SBarry Smith     ipvt[n] = n;
8965e19b50SBarry Smith     if (a[n + n * n] == 0.0) SETERRQ1(PETSC_COMM_SELF,PETSC_ERR_MAT_LU_ZRPVT,"Zero pivot, row %D",n-1);
903a40ed3dSBarry Smith     PetscFunctionReturn(0);
919fd41dd0SBarry Smith }
929fd41dd0SBarry Smith 
93