blob: 351489a31371562f0f1f20942a0c49e38ca7b7c2 [file] [log] [blame]
c---------------------------------------------------------------------
c---------------------------------------------------------------------
subroutine matvec_sub(ablock,avec,bvec)
c---------------------------------------------------------------------
c---------------------------------------------------------------------
c---------------------------------------------------------------------
c subtracts bvec=bvec - ablock*avec
c---------------------------------------------------------------------
implicit none
double precision ablock,avec,bvec
dimension ablock(5,5),avec(5),bvec(5)
c---------------------------------------------------------------------
c rhs(i,ic,jc,kc,ccell) = rhs(i,ic,jc,kc,ccell)
c $ - lhs(i,1,ablock,ia,ja,ka,acell)*
c---------------------------------------------------------------------
bvec(1) = bvec(1) - ablock(1,1)*avec(1)
> - ablock(1,2)*avec(2)
> - ablock(1,3)*avec(3)
> - ablock(1,4)*avec(4)
> - ablock(1,5)*avec(5)
bvec(2) = bvec(2) - ablock(2,1)*avec(1)
> - ablock(2,2)*avec(2)
> - ablock(2,3)*avec(3)
> - ablock(2,4)*avec(4)
> - ablock(2,5)*avec(5)
bvec(3) = bvec(3) - ablock(3,1)*avec(1)
> - ablock(3,2)*avec(2)
> - ablock(3,3)*avec(3)
> - ablock(3,4)*avec(4)
> - ablock(3,5)*avec(5)
bvec(4) = bvec(4) - ablock(4,1)*avec(1)
> - ablock(4,2)*avec(2)
> - ablock(4,3)*avec(3)
> - ablock(4,4)*avec(4)
> - ablock(4,5)*avec(5)
bvec(5) = bvec(5) - ablock(5,1)*avec(1)
> - ablock(5,2)*avec(2)
> - ablock(5,3)*avec(3)
> - ablock(5,4)*avec(4)
> - ablock(5,5)*avec(5)
return
end
c---------------------------------------------------------------------
c---------------------------------------------------------------------
subroutine matmul_sub(ablock, bblock, cblock)
c---------------------------------------------------------------------
c---------------------------------------------------------------------
c---------------------------------------------------------------------
c subtracts a(i,j,k) X b(i,j,k) from c(i,j,k)
c---------------------------------------------------------------------
implicit none
double precision ablock, bblock, cblock
dimension ablock(5,5), bblock(5,5), cblock(5,5)
cblock(1,1) = cblock(1,1) - ablock(1,1)*bblock(1,1)
> - ablock(1,2)*bblock(2,1)
> - ablock(1,3)*bblock(3,1)
> - ablock(1,4)*bblock(4,1)
> - ablock(1,5)*bblock(5,1)
cblock(2,1) = cblock(2,1) - ablock(2,1)*bblock(1,1)
> - ablock(2,2)*bblock(2,1)
> - ablock(2,3)*bblock(3,1)
> - ablock(2,4)*bblock(4,1)
> - ablock(2,5)*bblock(5,1)
cblock(3,1) = cblock(3,1) - ablock(3,1)*bblock(1,1)
> - ablock(3,2)*bblock(2,1)
> - ablock(3,3)*bblock(3,1)
> - ablock(3,4)*bblock(4,1)
> - ablock(3,5)*bblock(5,1)
cblock(4,1) = cblock(4,1) - ablock(4,1)*bblock(1,1)
> - ablock(4,2)*bblock(2,1)
> - ablock(4,3)*bblock(3,1)
> - ablock(4,4)*bblock(4,1)
> - ablock(4,5)*bblock(5,1)
cblock(5,1) = cblock(5,1) - ablock(5,1)*bblock(1,1)
> - ablock(5,2)*bblock(2,1)
> - ablock(5,3)*bblock(3,1)
> - ablock(5,4)*bblock(4,1)
> - ablock(5,5)*bblock(5,1)
cblock(1,2) = cblock(1,2) - ablock(1,1)*bblock(1,2)
> - ablock(1,2)*bblock(2,2)
> - ablock(1,3)*bblock(3,2)
> - ablock(1,4)*bblock(4,2)
> - ablock(1,5)*bblock(5,2)
cblock(2,2) = cblock(2,2) - ablock(2,1)*bblock(1,2)
> - ablock(2,2)*bblock(2,2)
> - ablock(2,3)*bblock(3,2)
> - ablock(2,4)*bblock(4,2)
> - ablock(2,5)*bblock(5,2)
cblock(3,2) = cblock(3,2) - ablock(3,1)*bblock(1,2)
> - ablock(3,2)*bblock(2,2)
> - ablock(3,3)*bblock(3,2)
> - ablock(3,4)*bblock(4,2)
> - ablock(3,5)*bblock(5,2)
cblock(4,2) = cblock(4,2) - ablock(4,1)*bblock(1,2)
> - ablock(4,2)*bblock(2,2)
> - ablock(4,3)*bblock(3,2)
> - ablock(4,4)*bblock(4,2)
> - ablock(4,5)*bblock(5,2)
cblock(5,2) = cblock(5,2) - ablock(5,1)*bblock(1,2)
> - ablock(5,2)*bblock(2,2)
> - ablock(5,3)*bblock(3,2)
> - ablock(5,4)*bblock(4,2)
> - ablock(5,5)*bblock(5,2)
cblock(1,3) = cblock(1,3) - ablock(1,1)*bblock(1,3)
> - ablock(1,2)*bblock(2,3)
> - ablock(1,3)*bblock(3,3)
> - ablock(1,4)*bblock(4,3)
> - ablock(1,5)*bblock(5,3)
cblock(2,3) = cblock(2,3) - ablock(2,1)*bblock(1,3)
> - ablock(2,2)*bblock(2,3)
> - ablock(2,3)*bblock(3,3)
> - ablock(2,4)*bblock(4,3)
> - ablock(2,5)*bblock(5,3)
cblock(3,3) = cblock(3,3) - ablock(3,1)*bblock(1,3)
> - ablock(3,2)*bblock(2,3)
> - ablock(3,3)*bblock(3,3)
> - ablock(3,4)*bblock(4,3)
> - ablock(3,5)*bblock(5,3)
cblock(4,3) = cblock(4,3) - ablock(4,1)*bblock(1,3)
> - ablock(4,2)*bblock(2,3)
> - ablock(4,3)*bblock(3,3)
> - ablock(4,4)*bblock(4,3)
> - ablock(4,5)*bblock(5,3)
cblock(5,3) = cblock(5,3) - ablock(5,1)*bblock(1,3)
> - ablock(5,2)*bblock(2,3)
> - ablock(5,3)*bblock(3,3)
> - ablock(5,4)*bblock(4,3)
> - ablock(5,5)*bblock(5,3)
cblock(1,4) = cblock(1,4) - ablock(1,1)*bblock(1,4)
> - ablock(1,2)*bblock(2,4)
> - ablock(1,3)*bblock(3,4)
> - ablock(1,4)*bblock(4,4)
> - ablock(1,5)*bblock(5,4)
cblock(2,4) = cblock(2,4) - ablock(2,1)*bblock(1,4)
> - ablock(2,2)*bblock(2,4)
> - ablock(2,3)*bblock(3,4)
> - ablock(2,4)*bblock(4,4)
> - ablock(2,5)*bblock(5,4)
cblock(3,4) = cblock(3,4) - ablock(3,1)*bblock(1,4)
> - ablock(3,2)*bblock(2,4)
> - ablock(3,3)*bblock(3,4)
> - ablock(3,4)*bblock(4,4)
> - ablock(3,5)*bblock(5,4)
cblock(4,4) = cblock(4,4) - ablock(4,1)*bblock(1,4)
> - ablock(4,2)*bblock(2,4)
> - ablock(4,3)*bblock(3,4)
> - ablock(4,4)*bblock(4,4)
> - ablock(4,5)*bblock(5,4)
cblock(5,4) = cblock(5,4) - ablock(5,1)*bblock(1,4)
> - ablock(5,2)*bblock(2,4)
> - ablock(5,3)*bblock(3,4)
> - ablock(5,4)*bblock(4,4)
> - ablock(5,5)*bblock(5,4)
cblock(1,5) = cblock(1,5) - ablock(1,1)*bblock(1,5)
> - ablock(1,2)*bblock(2,5)
> - ablock(1,3)*bblock(3,5)
> - ablock(1,4)*bblock(4,5)
> - ablock(1,5)*bblock(5,5)
cblock(2,5) = cblock(2,5) - ablock(2,1)*bblock(1,5)
> - ablock(2,2)*bblock(2,5)
> - ablock(2,3)*bblock(3,5)
> - ablock(2,4)*bblock(4,5)
> - ablock(2,5)*bblock(5,5)
cblock(3,5) = cblock(3,5) - ablock(3,1)*bblock(1,5)
> - ablock(3,2)*bblock(2,5)
> - ablock(3,3)*bblock(3,5)
> - ablock(3,4)*bblock(4,5)
> - ablock(3,5)*bblock(5,5)
cblock(4,5) = cblock(4,5) - ablock(4,1)*bblock(1,5)
> - ablock(4,2)*bblock(2,5)
> - ablock(4,3)*bblock(3,5)
> - ablock(4,4)*bblock(4,5)
> - ablock(4,5)*bblock(5,5)
cblock(5,5) = cblock(5,5) - ablock(5,1)*bblock(1,5)
> - ablock(5,2)*bblock(2,5)
> - ablock(5,3)*bblock(3,5)
> - ablock(5,4)*bblock(4,5)
> - ablock(5,5)*bblock(5,5)
return
end
c---------------------------------------------------------------------
c---------------------------------------------------------------------
subroutine binvcrhs( lhs,c,r )
c---------------------------------------------------------------------
c---------------------------------------------------------------------
c---------------------------------------------------------------------
c
c---------------------------------------------------------------------
implicit none
double precision pivot, coeff, lhs
dimension lhs(5,5)
double precision c(5,5), r(5)
c---------------------------------------------------------------------
c
c---------------------------------------------------------------------
pivot = 1.00d0/lhs(1,1)
lhs(1,2) = lhs(1,2)*pivot
lhs(1,3) = lhs(1,3)*pivot
lhs(1,4) = lhs(1,4)*pivot
lhs(1,5) = lhs(1,5)*pivot
c(1,1) = c(1,1)*pivot
c(1,2) = c(1,2)*pivot
c(1,3) = c(1,3)*pivot
c(1,4) = c(1,4)*pivot
c(1,5) = c(1,5)*pivot
r(1) = r(1) *pivot
coeff = lhs(2,1)
lhs(2,2)= lhs(2,2) - coeff*lhs(1,2)
lhs(2,3)= lhs(2,3) - coeff*lhs(1,3)
lhs(2,4)= lhs(2,4) - coeff*lhs(1,4)
lhs(2,5)= lhs(2,5) - coeff*lhs(1,5)
c(2,1) = c(2,1) - coeff*c(1,1)
c(2,2) = c(2,2) - coeff*c(1,2)
c(2,3) = c(2,3) - coeff*c(1,3)
c(2,4) = c(2,4) - coeff*c(1,4)
c(2,5) = c(2,5) - coeff*c(1,5)
r(2) = r(2) - coeff*r(1)
coeff = lhs(3,1)
lhs(3,2)= lhs(3,2) - coeff*lhs(1,2)
lhs(3,3)= lhs(3,3) - coeff*lhs(1,3)
lhs(3,4)= lhs(3,4) - coeff*lhs(1,4)
lhs(3,5)= lhs(3,5) - coeff*lhs(1,5)
c(3,1) = c(3,1) - coeff*c(1,1)
c(3,2) = c(3,2) - coeff*c(1,2)
c(3,3) = c(3,3) - coeff*c(1,3)
c(3,4) = c(3,4) - coeff*c(1,4)
c(3,5) = c(3,5) - coeff*c(1,5)
r(3) = r(3) - coeff*r(1)
coeff = lhs(4,1)
lhs(4,2)= lhs(4,2) - coeff*lhs(1,2)
lhs(4,3)= lhs(4,3) - coeff*lhs(1,3)
lhs(4,4)= lhs(4,4) - coeff*lhs(1,4)
lhs(4,5)= lhs(4,5) - coeff*lhs(1,5)
c(4,1) = c(4,1) - coeff*c(1,1)
c(4,2) = c(4,2) - coeff*c(1,2)
c(4,3) = c(4,3) - coeff*c(1,3)
c(4,4) = c(4,4) - coeff*c(1,4)
c(4,5) = c(4,5) - coeff*c(1,5)
r(4) = r(4) - coeff*r(1)
coeff = lhs(5,1)
lhs(5,2)= lhs(5,2) - coeff*lhs(1,2)
lhs(5,3)= lhs(5,3) - coeff*lhs(1,3)
lhs(5,4)= lhs(5,4) - coeff*lhs(1,4)
lhs(5,5)= lhs(5,5) - coeff*lhs(1,5)
c(5,1) = c(5,1) - coeff*c(1,1)
c(5,2) = c(5,2) - coeff*c(1,2)
c(5,3) = c(5,3) - coeff*c(1,3)
c(5,4) = c(5,4) - coeff*c(1,4)
c(5,5) = c(5,5) - coeff*c(1,5)
r(5) = r(5) - coeff*r(1)
pivot = 1.00d0/lhs(2,2)
lhs(2,3) = lhs(2,3)*pivot
lhs(2,4) = lhs(2,4)*pivot
lhs(2,5) = lhs(2,5)*pivot
c(2,1) = c(2,1)*pivot
c(2,2) = c(2,2)*pivot
c(2,3) = c(2,3)*pivot
c(2,4) = c(2,4)*pivot
c(2,5) = c(2,5)*pivot
r(2) = r(2) *pivot
coeff = lhs(1,2)
lhs(1,3)= lhs(1,3) - coeff*lhs(2,3)
lhs(1,4)= lhs(1,4) - coeff*lhs(2,4)
lhs(1,5)= lhs(1,5) - coeff*lhs(2,5)
c(1,1) = c(1,1) - coeff*c(2,1)
c(1,2) = c(1,2) - coeff*c(2,2)
c(1,3) = c(1,3) - coeff*c(2,3)
c(1,4) = c(1,4) - coeff*c(2,4)
c(1,5) = c(1,5) - coeff*c(2,5)
r(1) = r(1) - coeff*r(2)
coeff = lhs(3,2)
lhs(3,3)= lhs(3,3) - coeff*lhs(2,3)
lhs(3,4)= lhs(3,4) - coeff*lhs(2,4)
lhs(3,5)= lhs(3,5) - coeff*lhs(2,5)
c(3,1) = c(3,1) - coeff*c(2,1)
c(3,2) = c(3,2) - coeff*c(2,2)
c(3,3) = c(3,3) - coeff*c(2,3)
c(3,4) = c(3,4) - coeff*c(2,4)
c(3,5) = c(3,5) - coeff*c(2,5)
r(3) = r(3) - coeff*r(2)
coeff = lhs(4,2)
lhs(4,3)= lhs(4,3) - coeff*lhs(2,3)
lhs(4,4)= lhs(4,4) - coeff*lhs(2,4)
lhs(4,5)= lhs(4,5) - coeff*lhs(2,5)
c(4,1) = c(4,1) - coeff*c(2,1)
c(4,2) = c(4,2) - coeff*c(2,2)
c(4,3) = c(4,3) - coeff*c(2,3)
c(4,4) = c(4,4) - coeff*c(2,4)
c(4,5) = c(4,5) - coeff*c(2,5)
r(4) = r(4) - coeff*r(2)
coeff = lhs(5,2)
lhs(5,3)= lhs(5,3) - coeff*lhs(2,3)
lhs(5,4)= lhs(5,4) - coeff*lhs(2,4)
lhs(5,5)= lhs(5,5) - coeff*lhs(2,5)
c(5,1) = c(5,1) - coeff*c(2,1)
c(5,2) = c(5,2) - coeff*c(2,2)
c(5,3) = c(5,3) - coeff*c(2,3)
c(5,4) = c(5,4) - coeff*c(2,4)
c(5,5) = c(5,5) - coeff*c(2,5)
r(5) = r(5) - coeff*r(2)
pivot = 1.00d0/lhs(3,3)
lhs(3,4) = lhs(3,4)*pivot
lhs(3,5) = lhs(3,5)*pivot
c(3,1) = c(3,1)*pivot
c(3,2) = c(3,2)*pivot
c(3,3) = c(3,3)*pivot
c(3,4) = c(3,4)*pivot
c(3,5) = c(3,5)*pivot
r(3) = r(3) *pivot
coeff = lhs(1,3)
lhs(1,4)= lhs(1,4) - coeff*lhs(3,4)
lhs(1,5)= lhs(1,5) - coeff*lhs(3,5)
c(1,1) = c(1,1) - coeff*c(3,1)
c(1,2) = c(1,2) - coeff*c(3,2)
c(1,3) = c(1,3) - coeff*c(3,3)
c(1,4) = c(1,4) - coeff*c(3,4)
c(1,5) = c(1,5) - coeff*c(3,5)
r(1) = r(1) - coeff*r(3)
coeff = lhs(2,3)
lhs(2,4)= lhs(2,4) - coeff*lhs(3,4)
lhs(2,5)= lhs(2,5) - coeff*lhs(3,5)
c(2,1) = c(2,1) - coeff*c(3,1)
c(2,2) = c(2,2) - coeff*c(3,2)
c(2,3) = c(2,3) - coeff*c(3,3)
c(2,4) = c(2,4) - coeff*c(3,4)
c(2,5) = c(2,5) - coeff*c(3,5)
r(2) = r(2) - coeff*r(3)
coeff = lhs(4,3)
lhs(4,4)= lhs(4,4) - coeff*lhs(3,4)
lhs(4,5)= lhs(4,5) - coeff*lhs(3,5)
c(4,1) = c(4,1) - coeff*c(3,1)
c(4,2) = c(4,2) - coeff*c(3,2)
c(4,3) = c(4,3) - coeff*c(3,3)
c(4,4) = c(4,4) - coeff*c(3,4)
c(4,5) = c(4,5) - coeff*c(3,5)
r(4) = r(4) - coeff*r(3)
coeff = lhs(5,3)
lhs(5,4)= lhs(5,4) - coeff*lhs(3,4)
lhs(5,5)= lhs(5,5) - coeff*lhs(3,5)
c(5,1) = c(5,1) - coeff*c(3,1)
c(5,2) = c(5,2) - coeff*c(3,2)
c(5,3) = c(5,3) - coeff*c(3,3)
c(5,4) = c(5,4) - coeff*c(3,4)
c(5,5) = c(5,5) - coeff*c(3,5)
r(5) = r(5) - coeff*r(3)
pivot = 1.00d0/lhs(4,4)
lhs(4,5) = lhs(4,5)*pivot
c(4,1) = c(4,1)*pivot
c(4,2) = c(4,2)*pivot
c(4,3) = c(4,3)*pivot
c(4,4) = c(4,4)*pivot
c(4,5) = c(4,5)*pivot
r(4) = r(4) *pivot
coeff = lhs(1,4)
lhs(1,5)= lhs(1,5) - coeff*lhs(4,5)
c(1,1) = c(1,1) - coeff*c(4,1)
c(1,2) = c(1,2) - coeff*c(4,2)
c(1,3) = c(1,3) - coeff*c(4,3)
c(1,4) = c(1,4) - coeff*c(4,4)
c(1,5) = c(1,5) - coeff*c(4,5)
r(1) = r(1) - coeff*r(4)
coeff = lhs(2,4)
lhs(2,5)= lhs(2,5) - coeff*lhs(4,5)
c(2,1) = c(2,1) - coeff*c(4,1)
c(2,2) = c(2,2) - coeff*c(4,2)
c(2,3) = c(2,3) - coeff*c(4,3)
c(2,4) = c(2,4) - coeff*c(4,4)
c(2,5) = c(2,5) - coeff*c(4,5)
r(2) = r(2) - coeff*r(4)
coeff = lhs(3,4)
lhs(3,5)= lhs(3,5) - coeff*lhs(4,5)
c(3,1) = c(3,1) - coeff*c(4,1)
c(3,2) = c(3,2) - coeff*c(4,2)
c(3,3) = c(3,3) - coeff*c(4,3)
c(3,4) = c(3,4) - coeff*c(4,4)
c(3,5) = c(3,5) - coeff*c(4,5)
r(3) = r(3) - coeff*r(4)
coeff = lhs(5,4)
lhs(5,5)= lhs(5,5) - coeff*lhs(4,5)
c(5,1) = c(5,1) - coeff*c(4,1)
c(5,2) = c(5,2) - coeff*c(4,2)
c(5,3) = c(5,3) - coeff*c(4,3)
c(5,4) = c(5,4) - coeff*c(4,4)
c(5,5) = c(5,5) - coeff*c(4,5)
r(5) = r(5) - coeff*r(4)
pivot = 1.00d0/lhs(5,5)
c(5,1) = c(5,1)*pivot
c(5,2) = c(5,2)*pivot
c(5,3) = c(5,3)*pivot
c(5,4) = c(5,4)*pivot
c(5,5) = c(5,5)*pivot
r(5) = r(5) *pivot
coeff = lhs(1,5)
c(1,1) = c(1,1) - coeff*c(5,1)
c(1,2) = c(1,2) - coeff*c(5,2)
c(1,3) = c(1,3) - coeff*c(5,3)
c(1,4) = c(1,4) - coeff*c(5,4)
c(1,5) = c(1,5) - coeff*c(5,5)
r(1) = r(1) - coeff*r(5)
coeff = lhs(2,5)
c(2,1) = c(2,1) - coeff*c(5,1)
c(2,2) = c(2,2) - coeff*c(5,2)
c(2,3) = c(2,3) - coeff*c(5,3)
c(2,4) = c(2,4) - coeff*c(5,4)
c(2,5) = c(2,5) - coeff*c(5,5)
r(2) = r(2) - coeff*r(5)
coeff = lhs(3,5)
c(3,1) = c(3,1) - coeff*c(5,1)
c(3,2) = c(3,2) - coeff*c(5,2)
c(3,3) = c(3,3) - coeff*c(5,3)
c(3,4) = c(3,4) - coeff*c(5,4)
c(3,5) = c(3,5) - coeff*c(5,5)
r(3) = r(3) - coeff*r(5)
coeff = lhs(4,5)
c(4,1) = c(4,1) - coeff*c(5,1)
c(4,2) = c(4,2) - coeff*c(5,2)
c(4,3) = c(4,3) - coeff*c(5,3)
c(4,4) = c(4,4) - coeff*c(5,4)
c(4,5) = c(4,5) - coeff*c(5,5)
r(4) = r(4) - coeff*r(5)
return
end
c---------------------------------------------------------------------
c---------------------------------------------------------------------
subroutine binvrhs( lhs,r )
c---------------------------------------------------------------------
c---------------------------------------------------------------------
c---------------------------------------------------------------------
c
c---------------------------------------------------------------------
implicit none
double precision pivot, coeff, lhs
dimension lhs(5,5)
double precision r(5)
c---------------------------------------------------------------------
c
c---------------------------------------------------------------------
pivot = 1.00d0/lhs(1,1)
lhs(1,2) = lhs(1,2)*pivot
lhs(1,3) = lhs(1,3)*pivot
lhs(1,4) = lhs(1,4)*pivot
lhs(1,5) = lhs(1,5)*pivot
r(1) = r(1) *pivot
coeff = lhs(2,1)
lhs(2,2)= lhs(2,2) - coeff*lhs(1,2)
lhs(2,3)= lhs(2,3) - coeff*lhs(1,3)
lhs(2,4)= lhs(2,4) - coeff*lhs(1,4)
lhs(2,5)= lhs(2,5) - coeff*lhs(1,5)
r(2) = r(2) - coeff*r(1)
coeff = lhs(3,1)
lhs(3,2)= lhs(3,2) - coeff*lhs(1,2)
lhs(3,3)= lhs(3,3) - coeff*lhs(1,3)
lhs(3,4)= lhs(3,4) - coeff*lhs(1,4)
lhs(3,5)= lhs(3,5) - coeff*lhs(1,5)
r(3) = r(3) - coeff*r(1)
coeff = lhs(4,1)
lhs(4,2)= lhs(4,2) - coeff*lhs(1,2)
lhs(4,3)= lhs(4,3) - coeff*lhs(1,3)
lhs(4,4)= lhs(4,4) - coeff*lhs(1,4)
lhs(4,5)= lhs(4,5) - coeff*lhs(1,5)
r(4) = r(4) - coeff*r(1)
coeff = lhs(5,1)
lhs(5,2)= lhs(5,2) - coeff*lhs(1,2)
lhs(5,3)= lhs(5,3) - coeff*lhs(1,3)
lhs(5,4)= lhs(5,4) - coeff*lhs(1,4)
lhs(5,5)= lhs(5,5) - coeff*lhs(1,5)
r(5) = r(5) - coeff*r(1)
pivot = 1.00d0/lhs(2,2)
lhs(2,3) = lhs(2,3)*pivot
lhs(2,4) = lhs(2,4)*pivot
lhs(2,5) = lhs(2,5)*pivot
r(2) = r(2) *pivot
coeff = lhs(1,2)
lhs(1,3)= lhs(1,3) - coeff*lhs(2,3)
lhs(1,4)= lhs(1,4) - coeff*lhs(2,4)
lhs(1,5)= lhs(1,5) - coeff*lhs(2,5)
r(1) = r(1) - coeff*r(2)
coeff = lhs(3,2)
lhs(3,3)= lhs(3,3) - coeff*lhs(2,3)
lhs(3,4)= lhs(3,4) - coeff*lhs(2,4)
lhs(3,5)= lhs(3,5) - coeff*lhs(2,5)
r(3) = r(3) - coeff*r(2)
coeff = lhs(4,2)
lhs(4,3)= lhs(4,3) - coeff*lhs(2,3)
lhs(4,4)= lhs(4,4) - coeff*lhs(2,4)
lhs(4,5)= lhs(4,5) - coeff*lhs(2,5)
r(4) = r(4) - coeff*r(2)
coeff = lhs(5,2)
lhs(5,3)= lhs(5,3) - coeff*lhs(2,3)
lhs(5,4)= lhs(5,4) - coeff*lhs(2,4)
lhs(5,5)= lhs(5,5) - coeff*lhs(2,5)
r(5) = r(5) - coeff*r(2)
pivot = 1.00d0/lhs(3,3)
lhs(3,4) = lhs(3,4)*pivot
lhs(3,5) = lhs(3,5)*pivot
r(3) = r(3) *pivot
coeff = lhs(1,3)
lhs(1,4)= lhs(1,4) - coeff*lhs(3,4)
lhs(1,5)= lhs(1,5) - coeff*lhs(3,5)
r(1) = r(1) - coeff*r(3)
coeff = lhs(2,3)
lhs(2,4)= lhs(2,4) - coeff*lhs(3,4)
lhs(2,5)= lhs(2,5) - coeff*lhs(3,5)
r(2) = r(2) - coeff*r(3)
coeff = lhs(4,3)
lhs(4,4)= lhs(4,4) - coeff*lhs(3,4)
lhs(4,5)= lhs(4,5) - coeff*lhs(3,5)
r(4) = r(4) - coeff*r(3)
coeff = lhs(5,3)
lhs(5,4)= lhs(5,4) - coeff*lhs(3,4)
lhs(5,5)= lhs(5,5) - coeff*lhs(3,5)
r(5) = r(5) - coeff*r(3)
pivot = 1.00d0/lhs(4,4)
lhs(4,5) = lhs(4,5)*pivot
r(4) = r(4) *pivot
coeff = lhs(1,4)
lhs(1,5)= lhs(1,5) - coeff*lhs(4,5)
r(1) = r(1) - coeff*r(4)
coeff = lhs(2,4)
lhs(2,5)= lhs(2,5) - coeff*lhs(4,5)
r(2) = r(2) - coeff*r(4)
coeff = lhs(3,4)
lhs(3,5)= lhs(3,5) - coeff*lhs(4,5)
r(3) = r(3) - coeff*r(4)
coeff = lhs(5,4)
lhs(5,5)= lhs(5,5) - coeff*lhs(4,5)
r(5) = r(5) - coeff*r(4)
pivot = 1.00d0/lhs(5,5)
r(5) = r(5) *pivot
coeff = lhs(1,5)
r(1) = r(1) - coeff*r(5)
coeff = lhs(2,5)
r(2) = r(2) - coeff*r(5)
coeff = lhs(3,5)
r(3) = r(3) - coeff*r(5)
coeff = lhs(4,5)
r(4) = r(4) - coeff*r(5)
return
end