|
@@ -0,0 +1,647 @@
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//
|
|
|
+// Copyright 2010 Intel Corporation
|
|
|
+//
|
|
|
+// Licensed under the Apache License, Version 2.0 (the "License");
|
|
|
+// you may not use this file except in compliance with the License.
|
|
|
+// You may obtain a copy of the License at
|
|
|
+//
|
|
|
+// http://www.apache.org/licenses/LICENSE-2.0
|
|
|
+//
|
|
|
+// Unless required by applicable law or agreed to in writing, software
|
|
|
+// distributed under the License is distributed on an "AS IS" BASIS,
|
|
|
+// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
|
+// See the License for the specific language governing permissions and
|
|
|
+// limitations under the License.
|
|
|
+//
|
|
|
+//---------------------------------------------------------------------
|
|
|
+#define ablock(m,n) ablock[(m-1)+5*(n-1)]
|
|
|
+#define bblock(m,n) bblock[(m-1)+5*(n-1)]
|
|
|
+#define cblock(m,n) cblock[(m-1)+5*(n-1)]
|
|
|
+#define avec(m) avec[m-1]
|
|
|
+#define bvec(m) bvec[m-1]
|
|
|
+#define lhs(m,n) lhs[(m-1)+5*(n-1)]
|
|
|
+#define c(m,n) c[(m-1)+5*(n-1)]
|
|
|
+#define r(m) r[m-1]
|
|
|
+
|
|
|
+void matvec_sub(double ablock[],double avec[],double bvec[]) {
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+// subtracts bvec=bvec - ablock*avec
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+// rhs(i,ic,jc,kc,ccell) = rhs(i,ic,jc,kc,ccell)
|
|
|
+// $ - lhs(i,1,ablock,ia,ja,ka,acell)*
|
|
|
+//---------------------------------------------------------------------
|
|
|
+ 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;
|
|
|
+}
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+void matmul_sub(double ablock[], double bblock[], double cblock[]) {
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+// subtracts a(i,j,k) X b(i,j,k) from c(i,j,k)
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+
|
|
|
+ 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;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+void binvcrhs( double lhs[],double c[],double r[] ) {
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+ double pivot, coeff;
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+ pivot = 1.00e0/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.00e0/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.00e0/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.00e0/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.00e0/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;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+void binvrhs( double lhs[],double r[] ) {
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+ double pivot, coeff;
|
|
|
+
|
|
|
+//---------------------------------------------------------------------
|
|
|
+//
|
|
|
+//---------------------------------------------------------------------
|
|
|
+
|
|
|
+
|
|
|
+ pivot = 1.00e0/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.00e0/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.00e0/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.00e0/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.00e0/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;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+
|