[BACK]Return to mat.c CVS log [TXT][DIR] Up to [local] / OpenXM_contrib2 / asir2000 / engine

Diff for /OpenXM_contrib2/asir2000/engine/mat.c between version 1.4 and 1.17

version 1.4, 2002/01/04 17:08:23 version 1.17, 2018/03/29 01:32:52
Line 45 
Line 45 
  * DEVELOPER SHALL HAVE NO LIABILITY IN CONNECTION WITH THE USE,   * DEVELOPER SHALL HAVE NO LIABILITY IN CONNECTION WITH THE USE,
  * PERFORMANCE OR NON-PERFORMANCE OF THE SOFTWARE.   * PERFORMANCE OR NON-PERFORMANCE OF THE SOFTWARE.
  *   *
  * $OpenXM: OpenXM_contrib2/asir2000/engine/mat.c,v 1.3 2000/08/22 05:04:05 noro Exp $   * $OpenXM: OpenXM_contrib2/asir2000/engine/mat.c,v 1.16 2009/11/24 04:34:30 ohara Exp $
 */  */
 #include "ca.h"  #include "ca.h"
 #include "../parse/parse.h"  #include "../parse/parse.h"
   
 extern int StrassenSize;  extern int StrassenSize;
   /* remove miser type
   void mulmatmat_miser();
   */
   
 void addmat(vl,a,b,c)  void addmat(vl,a,b,c)
 VL vl;  VL vl;
 MAT a,b,*c;  MAT a,b,*c;
 {  {
         int row,col,i,j;    int row,col,i,j;
   MAT t;    MAT t;
   pointer *ab,*bb,*tb;    pointer *ab,*bb,*tb;
   
Line 72  MAT a,b,*c;
Line 75  MAT a,b,*c;
     for ( i = 0; i < row; i++ )      for ( i = 0; i < row; i++ )
       for ( j = 0, ab = BDY(a)[i], bb = BDY(b)[i], tb = BDY(t)[i];        for ( j = 0, ab = BDY(a)[i], bb = BDY(b)[i], tb = BDY(t)[i];
         j < col; j++ )          j < col; j++ )
         addr(vl,(Obj)ab[j],(Obj)bb[j],(Obj *)&tb[j]);          arf_add(vl,(Obj)ab[j],(Obj)bb[j],(Obj *)&tb[j]);
     *c = t;      *c = t;
   }    }
 }  }
Line 81  void submat(vl,a,b,c)
Line 84  void submat(vl,a,b,c)
 VL vl;  VL vl;
 MAT a,b,*c;  MAT a,b,*c;
 {  {
         int row,col,i,j;    int row,col,i,j;
   MAT t;    MAT t;
   pointer *ab,*bb,*tb;    pointer *ab,*bb,*tb;
   
Line 97  MAT a,b,*c;
Line 100  MAT a,b,*c;
     for ( i = 0; i < row; i++ )      for ( i = 0; i < row; i++ )
       for ( j = 0, ab = BDY(a)[i], bb = BDY(b)[i], tb = BDY(t)[i];        for ( j = 0, ab = BDY(a)[i], bb = BDY(b)[i], tb = BDY(t)[i];
         j < col; j++ )          j < col; j++ )
         subr(vl,(Obj)ab[j],(Obj)bb[j],(Obj *)&tb[j]);          arf_sub(vl,(Obj)ab[j],(Obj)bb[j],(Obj *)&tb[j]);
     *c = t;      *c = t;
   }    }
 }  }
   
   /* remove miser type
   void addmat_miser(vl,a,b,c,ar0,ac0,ar1,ac1,br0,bc0,br1,bc1)
   VL vl;
   MAT a,b,*c;
   int ar0,ac0,ar1,ac1,br0,bc0,br1,bc1;
   {
     int row,col,i,j;
     MAT t;
     pointer *ab,*bb,*tb;
     row = ar1 - ar0 + 1; col = ac1 - ac0 + 1;
   
     if ( !a )
       *c = b;
     else if ( !b )
       *c = a;
     else if ( (row != br1 - br0 + 1) || (col != bc1 - bc0 + 1) ) {
       *c = 0; error("addmat : size mismatch add");
     } else {
       MKMAT(t,row,col);
       for ( i = 0; i < row; i++ ) {
         if (i+ar0 > a->row-1) {
           ab = NULL;
         } else {
           ab = BDY(a)[i+ar0];
         }
         if (i+br0 > b->row-1) {
           bb = NULL;
         } else {
           bb = BDY(b)[i+br0];
         }
         tb = BDY(t)[i];
         for ( j =0; j < col; j++ ) {
           if ((ab == NULL || j+ac0 > a->col-1) && (bb == NULL || j+bc0 > b->col-1)) {
             arf_add(vl,NULL,NULL,(Obj *)&tb[j]);
           } else if ((ab != NULL && j+ac0 <= a->col-1) && (bb == NULL || j+bc0 > b->col-1)){
             arf_add(vl,(Obj)ab[j+ac0],NULL,(Obj *)&tb[j]);
           } else if ((ab == NULL || j+ac0 > a->col-1) && (bb != NULL && j+bc0 <= b->col-1)) {
             arf_add(vl,NULL, (Obj)bb[j+bc0],(Obj *)&tb[j]);
           } else {
             arf_add(vl,(Obj)ab[j+ac0],(Obj)bb[j+bc0],(Obj *)&tb[j]);
           }
   
         }
       }
       *c = t;
     }
   }
   
   void submat_miser(vl,a,b,c,ar0,ac0,ar1,ac1,br0,bc0,br1,bc1)
   VL vl;
   MAT a,b,*c;
   int ar0,ac0,ar1,ac1,br0,bc0,br1,bc1;
   {
     int row,col,i,j;
     MAT t;
     pointer *ab,*bb,*tb;
   
     row = ar1 - ar0 + 1; col = ac1 - ac0 + 1;
   
     if ( !a )
       chsgnmat(b,c);
     else if ( !b )
       *c = a;
     else if ( (row != br1 - br0 + 1) || (col != bc1 - bc0 + 1) ) {
       *c = 0; error("submat : size mismatch sub");
     } else {
       MKMAT(t,row,col);
       for ( i = 0; i < row; i++ ) {
         if (i+ar0 > a->row-1) {
           ab = NULL;
         } else {
           ab = BDY(a)[i+ar0];
         }
         if (i+br0 > b->row-1) {
           bb = NULL;
         } else {
           bb = BDY(b)[i+br0];
         }
         tb = BDY(t)[i];
         for ( j =0; j < col; j++ ) {
           if ((ab == NULL || j+ac0 > a->col-1) && (bb == NULL || j+bc0 > b->col-1)) {
             arf_sub(vl,NULL,NULL,(Obj *)&tb[j]);
           } else if ((ab != NULL && j+ac0 <= a->col-1) && (bb == NULL || j+bc0 > b->col-1)){
             arf_sub(vl,(Obj)ab[j+ac0],NULL,(Obj *)&tb[j]);
           } else if ((ab == NULL || j+ac0 > a->col-1) && (bb != NULL && j+bc0 <= b->col-1)) {
             arf_sub(vl,NULL, (Obj)bb[j+bc0],(Obj *)&tb[j]);
           } else {
             arf_sub(vl,(Obj)ab[j+ac0],(Obj)bb[j+bc0],(Obj *)&tb[j]);
           }
   
         }
       }
       *c = t;
     }
   }
   */
   
 void mulmat(vl,a,b,c)  void mulmat(vl,a,b,c)
 VL vl;  VL vl;
 Obj a,b,*c;  Obj a,b,*c;
 {  {
         if ( !a || !b )    VECT vect;
                 *c = 0;    MAT mat;
         else if ( OID(a) <= O_R )  
                 mulrmat(vl,(Obj)a,(MAT)b,(MAT *)c);  
         else if ( OID(b) <= O_R )  
                 mulrmat(vl,(Obj)b,(MAT)a,(MAT *)c);  
         else  
                 switch ( OID(a) ) {  
                         case O_VECT:  
                                 switch ( OID(b) ) {  
                                         case O_MAT:  
                                                 mulvectmat(vl,(VECT)a,(MAT)b,(VECT *)c); break;  
                                         case O_VECT: default:  
                                                 notdef(vl,a,b,c); break;  
                                 }  
                                 break;  
                         case O_MAT:  
                                 switch ( OID(b) ) {  
                                         case O_VECT:  
                                                 mulmatvect(vl,(MAT)a,(VECT)b,(VECT *)c); break;  
                                         case O_MAT:  
                                                 mulmatmat(vl,(MAT)a,(MAT)b,(MAT *)c); break;  
                                         default:  
                                                 notdef(vl,a,b,c); break;  
                                 }  
                                 break;  
                         default:  
                                 notdef(vl,a,b,c); break;  
                 }  
 }  
   
     if ( !a && !b )
       *c = 0;
     else if ( !a || !b ) {
       if ( !a )
         a = b;
       switch ( OID(a) ) {
         case O_VECT:
           MKVECT(vect,((VECT)a)->len);
           *c = (Obj)vect;
           break;
         case O_MAT:
           MKMAT(mat,((MAT)a)->row,((MAT)a)->col);
           *c = (Obj)mat;
           break;
         default:
           *c = 0;
           break;
       }
     } else if ( OID(a) <= O_R || OID(a) == O_DP )
       mulrmat(vl,(Obj)a,(MAT)b,(MAT *)c);
     else if ( OID(b) <= O_R || OID(b) == O_DP )
       mulrmat(vl,(Obj)b,(MAT)a,(MAT *)c);
     else
       switch ( OID(a) ) {
         case O_VECT:
           switch ( OID(b) ) {
             case O_MAT:
               mulvectmat(vl,(VECT)a,(MAT)b,(VECT *)c); break;
             case O_VECT: default:
               notdef(vl,a,b,c); break;
           }
           break;
         case O_MAT:
           switch ( OID(b) ) {
             case O_VECT:
               mulmatvect(vl,(MAT)a,(VECT)b,(VECT *)c); break;
             case O_MAT:
               mulmatmat(vl, (MAT)a, (MAT)b, (MAT *)c); break;
   /* remove miser type
               mulmatmat_miser(vl,(MAT)a,(MAT)b,(MAT *)c, 0,0, ((MAT)a)->row-1, ((MAT)a)->col-1, 0,0,((MAT)b)->row-1, ((MAT)b)->col-1); break;
   */
             default:
               notdef(vl,a,b,c); break;
           }
           break;
         default:
           notdef(vl,a,b,c); break;
       }
   }
   
 void divmat(vl,a,b,c)  void divmat(vl,a,b,c)
 VL vl;  VL vl;
 Obj a,b,*c;  Obj a,b,*c;
 {  {
         Obj t;    Obj t;
   
         if ( !b )    if ( !b )
                 error("divmat : division by 0");      error("divmat : division by 0");
         else if ( !a )    else if ( !a )
                 *c = 0;      *c = 0;
         else if ( OID(b) > O_R )    else if ( OID(b) > O_R )
                 notdef(vl,a,b,c);      notdef(vl,a,b,c);
         else {    else {
                 divr(vl,(Obj)ONE,b,&t); mulrmat(vl,t,(MAT)a,(MAT *)c);      arf_div(vl,(Obj)ONE,b,&t); mulrmat(vl,t,(MAT)a,(MAT *)c);
         }    }
 }  }
   
 void chsgnmat(a,b)  void chsgnmat(a,b)
 MAT a,*b;  MAT a,*b;
 {  {
         MAT t;    MAT t;
         int row,col,i,j;    int row,col,i,j;
         pointer *ab,*tb;    pointer *ab,*tb;
   
         if ( !a )    if ( !a )
                 *b = 0;      *b = 0;
         else {    else {
                 row = a->row; col = a->col;      row = a->row; col = a->col;
                 MKMAT(t,row,col);      MKMAT(t,row,col);
                 for ( i = 0; i < row; i++ )      for ( i = 0; i < row; i++ )
                         for ( j = 0, ab = BDY(a)[i], tb = BDY(t)[i];        for ( j = 0, ab = BDY(a)[i], tb = BDY(t)[i];
                                 j < col; j++ )          j < col; j++ )
                                 chsgnr((Obj)ab[j],(Obj *)&tb[j]);          arf_chsgn((Obj)ab[j],(Obj *)&tb[j]);
                 *b = t;      *b = t;
         }    }
 }  }
   
 void pwrmat(vl,a,r,c)  void pwrmat(vl,a,r,c)
Line 180  MAT a;
Line 302  MAT a;
 Obj r;  Obj r;
 MAT *c;  MAT *c;
 {  {
         if ( !a )    int n,i;
                 *c = 0;    MAT t;
         else if ( !r || !NUM(r) || !RATN(r) ||  
                 !INT(r) || (SGN((Q)r)<0) || (PL(NM((Q)r))>1) ) {    if ( !a )
                 *c = 0; error("pwrmat : invalid exponent");      *c = 0;
         } else if ( a->row != a->col ) {    else if ( !r ) {
                 *c = 0; error("pwrmat : non square matrix");      if ( a->row != a->col ) {
         }  else        *c = 0; error("pwrmat : non square matrix");
                 pwrmatmain(vl,a,QTOS((Q)r),c);      } else {
         n = a->row;
           MKMAT(t,n,n);
         for ( i = 0; i < n; i++ )
           t->body[i][i] = ONE;
         *c = t;
       }
     } else if ( !NUM(r) || !RATN(r) ||
       !INT(r) || (SGN((Q)r)<0) || (PL(NM((Q)r))>1) ) {
       *c = 0; error("pwrmat : invalid exponent");
     } else if ( a->row != a->col ) {
       *c = 0; error("pwrmat : non square matrix");
     }  else
       pwrmatmain(vl,a,QTOS((Q)r),c);
 }  }
   
 void pwrmatmain(vl,a,e,c)  void pwrmatmain(vl,a,e,c)
Line 197  MAT a;
Line 332  MAT a;
 int e;  int e;
 MAT *c;  MAT *c;
 {  {
         MAT t,s;    MAT t,s;
   
         if ( e == 1 ) {    if ( e == 1 ) {
                 *c = a;      *c = a;
                 return;      return;
         }    }
   
         pwrmatmain(vl,a,e/2,&t);    pwrmatmain(vl,a,e/2,&t);
         mulmat(vl,(Obj)t,(Obj)t,(Obj *)&s);    mulmat(vl,(Obj)t,(Obj)t,(Obj *)&s);
         if ( e % 2 )    if ( e % 2 )
                 mulmat(vl,(Obj)s,(Obj)a,(Obj *)c);      mulmat(vl,(Obj)s,(Obj)a,(Obj *)c);
         else    else
                 *c = s;      *c = s;
 }  }
   
 void mulrmat(vl,a,b,c)  void mulrmat(vl,a,b,c)
Line 217  VL vl;
Line 352  VL vl;
 Obj a;  Obj a;
 MAT b,*c;  MAT b,*c;
 {  {
         int row,col,i,j;    int row,col,i,j;
         MAT t;    MAT t;
         pointer *bb,*tb;    pointer *bb,*tb;
   
         if ( !a || !b )    if ( !a || !b )
                 *c = 0;      *c = 0;
         else {    else {
                 row = b->row; col = b->col;      row = b->row; col = b->col;
                 MKMAT(t,row,col);      MKMAT(t,row,col);
                 for ( i = 0; i < row; i++ )      for ( i = 0; i < row; i++ )
                         for ( j = 0, bb = BDY(b)[i], tb = BDY(t)[i];        for ( j = 0, bb = BDY(b)[i], tb = BDY(t)[i];
                                 j < col; j++ )          j < col; j++ )
                                 mulr(vl,(Obj)a,(Obj)bb[j],(Obj *)&tb[j]);          arf_mul(vl,(Obj)a,(Obj)bb[j],(Obj *)&tb[j]);
                 *c = t;      *c = t;
         }    }
 }  }
   
 void mulmatmat(vl,a,b,c)  void mulmatmat(vl,a,b,c)
 VL vl;  VL vl;
 MAT a,b,*c;  MAT a,b,*c;
 {  {
 #if 0    int arow,bcol,i,j,k,m, h, arowh, bcolh;
         int arow,bcol,i,j,k,m;    MAT t, a11, a12, a21, a22;
         MAT t;    MAT p, b11, b12, b21, b22;
         pointer s,u,v;    MAT ans1, ans2, ans3, c11, c12, c21, c22;
         pointer *ab,*tb;    MAT s1, s2, t1, t2, u1, v1, w1, aa, bb;
     pointer s,u,v;
     pointer *ab,*tb;
     int a1row,a2row, a3row,a4row, a1col, a2col, a3col, a4col;
     int b1row,b2row, b3row,b4row, b1col, b2col, b3col, b4col;
     int pflag1, pflag2, pflag3;
     /* mismach col and row */
     if ( a->col != b->row ) {
       *c = 0; error("mulmat : size mismatch");
     }
     else {
       pflag1 = 0; pflag2 = 0; pflag3 = 0;
       arow = a->row; m = a->col; bcol = b->col;
       MKMAT(t,arow,bcol);
       /* StrassenSize == 0 or matrix size less then StrassenSize,
       then calc cannonical algorithm. */
       if((StrassenSize == 0)||(a->row<=StrassenSize || a->col <= StrassenSize) || (b->row<=StrassenSize || b->col <= StrassenSize)) {
         for ( i = 0; i < arow; i++ )
           for ( j = 0, ab = BDY(a)[i], tb = BDY(t)[i]; j < bcol; j++ ) {
             for ( k = 0, s = 0; k < m; k++ ) {
               arf_mul(vl,(Obj)ab[k],(Obj)BDY(b)[k][j],(Obj *)&u);
               arf_add(vl,(Obj)s,(Obj)u,(Obj *)&v);
               s = v;
             }
             tb[j] = s;
           }
       *c = t;
       return;
       }
       /* padding odd col and row to even number for zero */
       i = arow/2;
       j = arow - i;
       if (i != j) {
         arow++;
         pflag1 = 1;
       }
       i = m/2;
       j = m - i;
       if (i != j) {
         m++;
         pflag2 = 1;
       }
   
         /* 行列のcol,rowの数があわない場合 */      i = bcol/2;
         if ( a->col != b->row ) {      j = bcol - i;
                 *c = 0; error("mulmat : size mismatch");      if (i != j) {
         } else {        bcol++;
                 arow = a->row; m = a->col; bcol = b->col;        pflag3 = 1;
                 MKMAt(t,arow,bcol);      }
                 for ( i = 0; i < arow; i++ )  
                         for ( j = 0, ab = BDY(a)[i], tb = BDY(t)[i]; j < bcol; j++ ) {  
                                 for ( k = 0, s = 0; k < m; k++ ) {  
                                         mulr(vl,(Obj)ab[k],(Obj)BDY(b)[k][j],(Obj *)&u);  
                                         addr(vl,(Obj)s,(Obj)u,(Obj *)&v);  
                                         s = v;  
                                 }  
                                 tb[j] = s;  
                         }  
                 *c = t;  
         }  
 }  
   
 void Strassen(arg, c)      /* split matrix A and B */
 NODE arg;      a1row = arow/2; a1col = m/2;
 Obj *c;      MKMAT(a11,a1row,a1col);
 {  
   MAT a,b;  
         VL vl;  
   
         /* tomo */  
         a = (MAT)ARG0(arg);  
         b = (MAT)ARG1(arg);  
         vl = CO;  
         strassen(CO, a, b, c);  
 }  
   
 void strassen(vl,a,b,c)  
 VL vl;  
 MAT a,b,*c;  
 {  
 #endif  
         int arow,bcol,i,j,k,m, h, arowh, bcolh;  
         MAT t, a11, a12, a21, a22;  
         MAT p, b11, b12, b21, b22;  
         MAT ans1, ans2, ans3, c11, c12, c21, c22;  
         MAT s1, s2, t1, t2, u1, v1, w1, aa, bb;  
         pointer s,u,v;  
         pointer *ab,*tb;  
         int a1row,a2row, a3row,a4row, a1col, a2col, a3col, a4col;  
         int b1row,b2row, b3row,b4row, b1col, b2col, b3col, b4col;  
         int pflag1, pflag2;  
         /* 行列のcol,rowの数があわない場合 */  
         if ( a->col != b->row ) {  
                 *c = 0; error("mulmat : size mismatch");  
         }  
         else {  
                 pflag1 = 0; pflag2 = 0;  
                 arow = a->row; m = a->col; bcol = b->col;  
                 arowh = arow/2; bcolh = bcol/2;  
                 MKMAT(t,arow,bcol);  
                 /* StrassenSize == 0 or matrix size less then StrassenSize,  
                 then calc cannonical algorizm. */  
                 if((StrassenSize == 0)||(a->row<=StrassenSize || a->col <= StrassenSize)) {  
                         for ( i = 0; i < arow; i++ )  
                                 for ( j = 0, ab = BDY(a)[i], tb = BDY(t)[i]; j < bcol; j++ ) {  
                                         for ( k = 0, s = 0; k < m; k++ ) {  
                                                 mulr(vl,(Obj)ab[k],(Obj)BDY(b)[k][j],(Obj *)&u);  
                                                 addr(vl,(Obj)s,(Obj)u,(Obj *)&v);  
                                                 s = v;  
                                         }  
                                         tb[j] = s;  
                                 }  
                 *c = t;  
                 return;  
                 }  
                 /* 行列が奇数次の場合は偶数次になるように0でpadding */  
                 i = arow/2;  
                 j = arow - i;  
                 if (i != j) {  
                         arow++;  
                         pflag1 = 1;  
                 }  
                 i = m/2;  
                 j = m - i;  
                 if (i != j) {  
                         m++;  
                         pflag2 = 1;  
                 }  
                 MKMAT(aa, arow, m);  
                 for (i = 0; i < a->row; i++) {  
                         for (j = 0; j < a->col; j++) {  
                                 aa->body[i][j] = a->body[i][j];  
                         }  
                 }  
                 i = bcol/2;  
                 j = bcol - i;  
                 if (i != j) {  
                         bcol++;  
                 }  
                 MKMAT(bb, m, bcol);  
                 for (i = 0; i < b->row; i++) {  
                         for ( j = 0; j < b->col; j++) {  
                                 bb->body[i][j] = b->body[i][j];  
                         }  
                 }  
   
                 /* 行列A,Bを分割 */  
                 a1row = aa->row/2; a1col = aa->col/2;  
                 MKMAT(a11,a1row,a1col);  
     MKMAT(a21,a1row,a1col);      MKMAT(a21,a1row,a1col);
     MKMAT(a12,a1row,a1col);      MKMAT(a12,a1row,a1col);
     MKMAT(a22,a1row,a1col);      MKMAT(a22,a1row,a1col);
   
                 b1row = bb->row/2; b1col = bb->col/2;      b1row = m/2; b1col = bcol/2;
                 MKMAT(b11,b1row,b1col);      MKMAT(b11,b1row,b1col);
     MKMAT(b21,b1row,b1col);      MKMAT(b21,b1row,b1col);
     MKMAT(b12,b1row,b1col);      MKMAT(b12,b1row,b1col);
     MKMAT(b22,b1row,b1col);      MKMAT(b22,b1row,b1col);
   
                 /* a11の行列を作る */      /* make a11 matrix */
                 for (i = 0; i < a1row; i++) {      for (i = 0; i < a1row; i++) {
                         for (j = 0; j < a1col; j++) {        for (j = 0; j < a1col; j++) {
                                 a11->body[i][j] = aa->body[i][j];          a11->body[i][j] = a->body[i][j];
                         }        }
                 }      }
   
                 /* a21の行列を作る */      /* make a21 matrix */
                 for (i = a1row; i < aa->row; i++) {      for (i = a1row; i < a->row; i++) {
                         for (j = 0; j < a1col; j++) {        for (j = 0; j < a1col; j++) {
                                 a21->body[i-a1row][j] = aa->body[i][j];          a21->body[i-a1row][j] = a->body[i][j];
                         }        }
                 }      }
   
                 /* a12の行列を作る */      /* create a12 matrix */
                 for (i = 0; i < a1row; i++) {      for (i = 0; i < a1row; i++) {
                         for (j = a1col; j < aa->col; j++) {        for (j = a1col; j < a->col; j++) {
                                 a12->body[i][j-a1col] = aa->body[i][j];          a12->body[i][j-a1col] = a->body[i][j];
                         }        }
                 }      }
   
                 /* a22の行列を作る */      /* create a22 matrix */
     for (i = a1row; i < aa->row; i++) {      for (i = a1row; i < a->row; i++) {
       for (j = a1col; j < aa->col; j++) {        for (j = a1col; j < a->col; j++) {
         a22->body[i-a1row][j-a1col] = aa->body[i][j];          a22->body[i-a1row][j-a1col] = a->body[i][j];
       }        }
    }     }
   
   
                 /* b11の行列を作る */      /* create b11 submatrix */
                 for (i = 0; i < b1row; i++) {      for (i = 0; i < b1row; i++) {
                         for (j = 0; j < b1col; j++) {        for (j = 0; j < b1col; j++) {
                                 b11->body[i][j] = bb->body[i][j];          b11->body[i][j] = b->body[i][j];
                         }        }
                 }      }
   
                 /* b21の行列を作る */      /* create b21 submatrix */
                 for (i = b1row; i < bb->row; i++) {      for (i = b1row; i < b->row; i++) {
                         for (j = 0; j < b1col; j++) {        for (j = 0; j < b1col; j++) {
                                 b21->body[i-b1row][j] = bb->body[i][j];          b21->body[i-b1row][j] = b->body[i][j];
                         }        }
                 }      }
   
                 /* b12の行列を作る */      /* create b12 submatrix */
                 for (i = 0; i < b1row; i++) {      for (i = 0; i < b1row; i++) {
                         for (j = b1col; j < bb->col; j++) {        for (j = b1col; j < b->col; j++) {
                                 b12->body[i][j-b1col] = bb->body[i][j];          b12->body[i][j-b1col] = b->body[i][j];
                         }        }
                 }      }
   
                 /* b22の行列を作る */      /* create b22 submatrix */
                 for (i = b1row; i < bb->row; i++) {      for (i = b1row; i < b->row; i++) {
                         for (j = b1col; j < bb->col; j++) {        for (j = b1col; j < b->col; j++) {
                                 b22->body[i-b1row][j-b1col] = bb->body[i][j];          b22->body[i-b1row][j-b1col] = b->body[i][j];
                         }        }
                 }      }
                 /* Strassen-Winogradの方法で展開 */  
                 /* s1=A21+A22 */  
                 addmat(vl,a21,a22,&s1);  
   
                 /* s2=s1-A11 */      /* extension by zero */
                 submat(vl,s1,a11,&s2);      if (pflag1) {
         for (j = 0; j < a1col; j++) {
           a21->body[a1row-1][j] = 0; /* null */
         }
         for (j = a1col; j < a->col; j++) {
           a22->body[a1row-1][j-a1col] = 0;
         }
       }
       if (pflag2) {
         for (i = 0; i < a1row; i++) {
           a12->body[i][a1col-1] = 0;
         }
         for (i = a1row; i < a->row; i++) {
           a22->body[i-a1row][a1col-1] = 0;
         }
         for (j = 0; j < b1col; j++) {
           b21->body[b1row-1][j] = 0;
         }
         for (j = b1col; j < b->col; j++) {
           b22->body[b1row-1][j-b1col] = 0;
         }
       }
       if (pflag3) {
         for (i = 0; i < b1row; i++) {
           b12->body[i][b1col-1] = 0;
         }
         for (i = b1row; i < b->row; i++) {
           b22->body[i-b1row][b1col-1] = 0;
         }
       }
   
                 /* t1=B12-B11 */      /* expand matrix by Strassen-Winograd algorithm */
                 submat(vl, b12, b11, &t1);      /* s1=A21+A22 */
       addmat(vl,a21,a22,&s1);
   
                 /* t2=B22-t1 */      /* s2=s1-A11 */
                 submat(vl, b22, t1, &t2);      submat(vl,s1,a11,&s2);
   
                 /* u=(A11-A21)*(B22-B12) */      /* t1=B12-B11 */
                 submat(vl, a11, a21, &ans1);      submat(vl, b12, b11, &t1);
                 submat(vl, b22, b12, &ans2);  
                 mulmatmat(vl, ans1, ans2, &u1);  
 /* tomo  
                 strassen(vl, ans1, ans2, &u1);  
 */  
   
                 /* v=s1*t1 */      /* t2=B22-t1 */
                 mulmatmat(vl, s1, t1, &v1);      submat(vl, b22, t1, &t2);
 /* tomo  
                 strassen(vl, s1, t1, &v1);  
 */  
   
                 /* w=A11*B11+s2*t2 */      /* u=(A11-A21)*(B22-B12) */
                 mulmatmat(vl, a11, b11, &ans1);      submat(vl, a11, a21, &ans1);
                 mulmatmat(vl, s2, t2, &ans2);      submat(vl, b22, b12, &ans2);
 /* tomo      mulmatmat(vl, ans1, ans2, &u1);
                 strassen(vl, a11, b11, &ans1);  
                 strassen(vl, s2, t2, &ans2);  
 */  
                 addmat(vl, ans1, ans2, &w1);  
   
                 /* C11 = A11*B11+A12*B21 */      /* v=s1*t1 */
                 mulmatmat(vl, a12, b21, &ans2);      mulmatmat(vl, s1, t1, &v1);
 /* tomo  
                 strassen(vl,  a12, b21, &ans2);  
 */  
                 addmat(vl, ans1, ans2, &c11);  
   
                 /* C12 = w1+v1+(A12-s2)*B22 */      /* w=A11*B11+s2*t2 */
                 submat(vl, a12, s2, &ans1);      mulmatmat(vl, a11, b11, &ans1);
                 mulmatmat(vl, ans1, b22, &ans2);      mulmatmat(vl, s2, t2, &ans2);
 /* tomo      addmat(vl, ans1, ans2, &w1);
                 strassen(vl,  ans1, b22, &ans2);  
 */  
                 addmat(vl, w1, v1, &ans1);  
                 addmat(vl, ans1, ans2, &c12);  
   
                 /* C21 = w1+u1+A22*(B21-t2) */      /* C11 = A11*B11+A12*B21 */
                 submat(vl, b21, t2, &ans1);      mulmatmat(vl, a12, b21, &ans2);
                 mulmatmat(vl, a22, ans1, &ans2);      addmat(vl, ans1, ans2, &c11);
 /* tomo  
                 strassen(vl,  a22, ans1, &ans2);  
 */  
                 addmat(vl, w1, u1, &ans1);  
                 addmat(vl, ans1, ans2, &c21);  
   
                 /* C22 = w1 + u1 + v1 */      /* C12 = w1+v1+(A12-s2)*B22 */
                 addmat(vl, ans1, v1, &c22);      submat(vl, a12, s2, &ans1);
       mulmatmat(vl, ans1, b22, &ans2);
       addmat(vl, w1, v1, &ans1);
       addmat(vl, ans1, ans2, &c12);
   
         }      /* C21 = w1+u1+A22*(B21-t2) */
       submat(vl, b21, t2, &ans1);
       mulmatmat(vl, a22, ans1, &ans2);
       addmat(vl, w1, u1, &ans1);
       addmat(vl, ans1, ans2, &c21);
   
         /* 解の領域tに計算結果を戻す */      /* C22 = w1 + u1 + v1 */
         for(i =0; i<c11->row; i++) {      addmat(vl, ans1, v1, &c22);
                 for ( j=0; j < c11->col; j++) {    }
                         t->body[i][j] = c11->body[i][j];  
                 }    for(i =0; i<c11->row; i++) {
         }      for ( j=0; j < c11->col; j++) {
         if (pflag1 == 0) {        t->body[i][j] = c11->body[i][j];
                         k = c21->row;      }
         } else {    }
                         k = c21->row - 1;    if (pflag1 == 0) {
         }        k = c21->row;
         for(i =0; i<k; i++) {    } else {
                 for ( j=0; j < c21->col; j++) {        k = c21->row - 1;
                         t->body[i+c11->row][j] = c21->body[i][j];    }
                 }    for(i =0; i<k; i++) {
         }      for ( j=0; j < c21->col; j++) {
         if (pflag2 == 0) {        t->body[i+c11->row][j] = c21->body[i][j];
                 h = c12->col;      }
         } else {    }
                 h = c12->col -1;    if (pflag2 == 0) {
         }      h = c12->col;
         for(i =0; i<c12->row; i++) {    } else {
                 for ( j=0; j < k; j++) {      h = c12->col -1;
                         t->body[i][j+c11->col] = c12->body[i][j];    }
                 }    for(i =0; i<c12->row; i++) {
         }      for ( j=0; j < k; j++) {
         if (pflag1 == 0) {        t->body[i][j+c11->col] = c12->body[i][j];
                 k = c22->row;      }
         } else {    }
                 k = c22->row -1;    if (pflag1 == 0) {
         }      k = c22->row;
         if (pflag2 == 0) {    } else {
                 h = c22->col;      k = c22->row -1;
         } else {    }
                 h = c22->col - 1;    if (pflag2 == 0) {
         }      h = c22->col;
         for(i =0; i<k; i++) {    } else {
                 for ( j=0; j < h; j++) {      h = c22->col - 1;
                         t->body[i+c11->row][j+c11->col] = c22->body[i][j];    }
                 }    for(i =0; i<k; i++) {
         }      for ( j=0; j < h; j++) {
         *c = t;        t->body[i+c11->row][j+c11->col] = c22->body[i][j];
       }
     }
     *c = t;
 }  }
   
   #if 0
   /* remove miser type */
   void mulmatmat_miser(vl,a,b,c,ar0,ac0,ar1,ac1,br0,bc0,br1,bc1)
   VL vl;
   MAT a,b,*c;
   int ar0, ac0, ar1, ac1, br0, bc0, br1, bc1;
   {
     int arow,bcol,i,j,k,m, h;
     MAT t, a11, a12, a21, a22;
     MAT p, b11, b12, b21, b22;
     MAT ans1, ans2, c11, c12, c21, c22;
     MAT s1, s2, t1, t2, u1, v1, w1;
     pointer s,u,v;
     pointer *ab,*tb, *bb;
     int a1row, a1col;
     int b1row, b1col;
     int pflag1, pflag2;
   
     arow = ar1-ar0 + 1; m = ac1-ac0 + 1; bcol = bc1 - bc0 + 1;
     /* mismach col and row */
     if ( m != br1-br0 + 1 ) {
       *c = 0; error("mulmat : size mismatch");
     }
     else {
       pflag1 = 0; pflag2 = 0;
       MKMAT(t,arow,bcol);
       /* StrassenSize == 0 or matrix size less then StrassenSize,
       then calc cannonical algorithm. */
       if((StrassenSize == 0)||(arow<=StrassenSize || m <= StrassenSize) || (m<=StrassenSize || bcol <= StrassenSize)) {
         for ( i = 0; i < arow; i++ ) {
           if (i+ar0 > a->row-1) {
             ab = NULL;
           } else {
             ab = BDY(a)[i+ar0];
           }
           tb = BDY(t)[i];
           for ( j = 0; j < bcol; j++ ) {
             for ( k = 0, s = 0; k < m; k++ ) {
               if (k+br0 > b->row-1) {
                 bb = NULL;
               } else {
                 bb = BDY(b)[k+br0];
               }
               if ((ab == NULL || k+ac0 > a->col-1) && (bb == NULL || j+bc0 > b->col-1)) {
                 arf_mul(vl,NULL,NULL,(Obj *)&u);
               } else if ((ab != NULL && k+ac0 <= a->col-1) && (bb == NULL || j+bc0 > b->col-1)){
                 arf_mul(vl,(Obj)ab[k+ac0],NULL,(Obj *)&u);
               } else if ((ab == NULL || k+ac0 > a->col-1) && (bb != NULL && j+bc0 <= b->col-1)) {
                 arf_mul(vl,NULL,(Obj)bb[j+bc0],(Obj *)&u);
               } else {
                 arf_mul(vl,(Obj)ab[k+ac0],(Obj)bb[j+bc0],(Obj *)&u);
               }
               arf_add(vl,(Obj)s,(Obj)u,(Obj *)&v);
               s = v;
             }
             tb[j] = s;
           }
         }
       *c = t;
       return;
   
       }
       /* padding odd col and row to even number for zero */
       i = arow/2;
       j = arow - i;
       if (i != j) {
         arow++;
         pflag1 = 1;
       }
       i = m/2;
       j = m - i;
       if (i != j) {
         m++;
         pflag2 = 1;
       }
   
       i = bcol/2;
       j = bcol - i;
       if (i != j) {
         bcol++;
       }
   
       /* split matrix A and B */
       a1row = arow/2; a1col = m/2;
       b1row = m/2; b1col = bcol/2;
   
       /* expand matrix by Strassen-Winograd algorithm */
       /* s1=A21+A22 */
       addmat_miser(vl,a,a,&s1, ar0 + a1row, ac0, ar0 + arow -1, ac0 + a1col-1, ar0 + a1row, ac0 + a1col, ar0 + arow -1, ac0 + m-1);
   
       /* s2=s1-A11 */
       submat_miser(vl,s1,a,&s2, 0,0, s1->row-1, s1->col-1, ar0, ac0, ar0 + a1row-1, ac0 + a1col-1);
   
       /* t1=B12-B11 */
       submat_miser(vl, b, b, &t1, br0, bc0 + b1col, br0 + b1row-1, bc0 + bcol - 1, br0,bc0,br0 + b1row-1, bc0 + b1col-1);
   
       /* t2=B22-t1 */
       submat_miser(vl, b, t1, &t2, br0 + b1row, bc0 + b1col, br0 + m-1, bc0 + bcol-1, 0,0,t1->row-1, t1->col-1);
   
       /* u=(A11-A21)*(B22-B12) */
       submat_miser(vl, a, a, &ans1, ar0, ac0, ar0 + a1row-1,ac0 + a1col-1, ar0 + a1row, ac0, ar0 + arow-1, ac0 + a1col-1);
       submat_miser(vl, b, b, &ans2, br0 + b1row, bc0 + b1col, br0 + m-1, bc0 + bcol-1, br0, bc0 + b1col, br0 + b1row-1, bc0 + bcol-1);
       mulmatmat_miser(vl, ans1, ans2, &u1, 0, 0, ans1->row -1, ans1->col-1, 0, 0, ans2->row -1, ans2->col-1);
   
       /* v=s1*t1 */
       mulmatmat_miser(vl, s1, t1, &v1, 0, 0, s1->row -1, s1->col-1, 0, 0, t1->row -1, t1->col-1);
   
       /* w=A11*B11+s2*t2 */
       mulmatmat_miser(vl, a, b, &ans1, ar0, ac0, ar0 + a1row-1,ac0 + a1col-1, br0, bc0, br0 + b1row-1,bc0 + b1col-1);
       mulmatmat_miser(vl, s2, t2, &ans2, 0, 0, s2->row -1, s2->col-1, 0, 0, t2->row -1, t2->col-1);
       addmat_miser(vl, ans1, ans2, &w1, 0, 0, ans1->row -1, ans1->col-1, 0, 0, ans2->row -1, ans2->col-1);
   
       /* C11 = A11*B11+A12*B21 */
       mulmatmat_miser(vl, a, b, &ans2, ar0, ac0 + a1col, ar0 + a1row-1, ac0 + m-1, br0 + b1row, bc0 + 0, br0 + m-1, bc0 + b1col-1);
       addmat_miser(vl, ans1, ans2, &c11, 0, 0, ans1->row -1, ans1->col -1, 0, 0, ans2->row -1, ans2->col-1);
   
       /* C12 = w1+v1+(A12-s2)*B22 */
       submat_miser(vl, a, s2, &ans1, ar0, ac0 + a1col, ar0 + a1row-1, ac0 + m-1, 0, 0, s2->row -1, s2->col -1);
       mulmatmat_miser(vl, ans1, b, &ans2, 0, 0, ans1->row -1, ans1->col -1, br0 + b1row, bc0 + b1col, br0 + m-1, bc0 + bcol-1);
       addmat_miser(vl, w1, v1, &ans1, 0, 0, w1->row -1, w1->col -1, 0,0, v1->row-1, v1->col -1);
       addmat_miser(vl, ans1, ans2, &c12, 0, 0, ans1->row -1, ans1->col -1, 0, 0, ans2->row -1, ans2->col-1);
   
       /* C21 = w1+u1+A22*(B21-t2) */
       submat_miser(vl, b, t2, &ans1, br0 + b1row, bc0 + 0, br0 + m-1, bc0 + b1col-1, 0,0, t2->row-1, t2->col-1);
       mulmatmat_miser(vl, a, ans1, &ans2, ar0 + a1row, ac0 + a1col, ar0 + arow-1, ac0 + m-1, 0, 0, ans1->row -1, ans1->col -1);
       addmat_miser(vl, w1, u1, &ans1, 0,0,w1->row -1, w1->col-1, 0,0,u1->row -1, u1->col-1);
       addmat_miser(vl, ans1, ans2, &c21, 0, 0, ans1->row -1, ans1->col -1, 0, 0, ans2->row -1, ans2->col-1);
   
       /* C22 = w1 + u1 + v1 */
       addmat_miser(vl, ans1, v1, &c22, 0, 0, ans1->row -1, ans1->col -1, 0, 0, v1->row-1, v1->col-1);
     }
   
     for(i =0; i<c11->row; i++) {
       for ( j=0; j < c11->col; j++) {
         t->body[i][j] = c11->body[i][j];
       }
     }
     if (pflag1 == 0) {
         k = c21->row;
     } else {
         k = c21->row - 1;
     }
     for(i =0; i<k; i++) {
       for ( j=0; j < c21->col; j++) {
         t->body[i+c11->row][j] = c21->body[i][j];
       }
     }
     if (pflag2 == 0) {
       h = c12->col;
     } else {
       h = c12->col -1;
     }
     for(i =0; i<c12->row; i++) {
       for ( j=0; j < k; j++) {
         t->body[i][j+c11->col] = c12->body[i][j];
       }
     }
     if (pflag1 == 0) {
       k = c22->row;
     } else {
       k = c22->row -1;
     }
     if (pflag2 == 0) {
       h = c22->col;
     } else {
       h = c22->col - 1;
     }
     for(i =0; i<k; i++) {
       for ( j=0; j < h; j++) {
         t->body[i+c11->row][j+c11->col] = c22->body[i][j];
       }
     }
     *c = t;
   }
   #endif
   
 void mulmatvect(vl,a,b,c)  void mulmatvect(vl,a,b,c)
 VL vl;  VL vl;
 MAT a;  MAT a;
 VECT b;  VECT b;
 VECT *c;  VECT *c;
 {  {
         int arow,i,j,m;    int arow,i,j,m;
         VECT t;    VECT t;
         pointer s,u,v;    pointer s,u,v;
         pointer *ab;    pointer *ab;
   
         if ( !a || !b )    if ( !a || !b )
                 *c = 0;      *c = 0;
         else if ( a->col != b->len ) {    else if ( a->col != b->len ) {
                 *c = 0; error("mulmatvect : size mismatch");      *c = 0; error("mulmatvect : size mismatch");
         } else {    } else {
                 arow = a->row; m = a->col;  #if 0
                 MKVECT(t,arow);      for ( i = 0; i < b->len; i++ )
                 for ( i = 0; i < arow; i++ ) {        if ( BDY(b)[i] && OID((Obj)BDY(b)[i]) > O_R )
                         for ( j = 0, s = 0, ab = BDY(a)[i]; j < m; j++ ) {          error("mulmatvect : invalid argument");
                                 mulr(vl,(Obj)ab[j],(Obj)BDY(b)[j],(Obj *)&u); addr(vl,(Obj)s,(Obj)u,(Obj *)&v); s = v;  #endif
                         }      arow = a->row; m = a->col;
                         BDY(t)[i] = s;      MKVECT(t,arow);
                 }      for ( i = 0; i < arow; i++ ) {
                 *c = t;        for ( j = 0, s = 0, ab = BDY(a)[i]; j < m; j++ ) {
         }          arf_mul(vl,(Obj)ab[j],(Obj)BDY(b)[j],(Obj *)&u); arf_add(vl,(Obj)s,(Obj)u,(Obj *)&v); s = v;
         }
         BDY(t)[i] = s;
       }
       *c = t;
     }
 }  }
   
 void mulvectmat(vl,a,b,c)  void mulvectmat(vl,a,b,c)
Line 562  VECT a;
Line 833  VECT a;
 MAT b;  MAT b;
 VECT *c;  VECT *c;
 {  {
         int bcol,i,j,m;    int bcol,i,j,m;
         VECT t;    VECT t;
         pointer s,u,v;    pointer s,u,v;
   
         if ( !a || !b )    if ( !a || !b )
                 *c = 0;      *c = 0;
         else if ( a->len != b->row ) {    else if ( a->len != b->row ) {
                 *c = 0; error("mulvectmat : size mismatch");      *c = 0; error("mulvectmat : size mismatch");
         } else {    } else {
                 bcol = b->col; m = a->len;      for ( i = 0; i < a->len; i++ )
                 MKVECT(t,bcol);        if ( BDY(a)[i] && OID((Obj)BDY(a)[i]) > O_R )
                 for ( j = 0; j < bcol; j++ ) {          error("mulvectmat : invalid argument");
                         for ( i = 0, s = 0; i < m; i++ ) {      bcol = b->col; m = a->len;
                                 mulr(vl,(Obj)BDY(a)[i],(Obj)BDY(b)[i][j],(Obj *)&u); addr(vl,(Obj)s,(Obj)u,(Obj *)&v); s = v;      MKVECT(t,bcol);
                         }      for ( j = 0; j < bcol; j++ ) {
                         BDY(t)[j] = s;        for ( i = 0, s = 0; i < m; i++ ) {
                 }          arf_mul(vl,(Obj)BDY(a)[i],(Obj)BDY(b)[i][j],(Obj *)&u); arf_add(vl,(Obj)s,(Obj)u,(Obj *)&v); s = v;
                 *c = t;        }
         }        BDY(t)[j] = s;
       }
       *c = t;
     }
 }  }
   
 int compmat(vl,a,b)  int compmat(vl,a,b)
 VL vl;  VL vl;
 MAT a,b;  MAT a,b;
 {  {
         int i,j,t,row,col;    int i,j,t,row,col;
   
         if ( !a )    if ( !a )
                 return b?-1:0;      return b?-1:0;
         else if ( !b )    else if ( !b )
                 return 1;      return 1;
         else if ( a->row != b->row )    else if ( a->row != b->row )
                 return a->row>b->row ? 1 : -1;      return a->row>b->row ? 1 : -1;
         else if (a->col != b->col )    else if (a->col != b->col )
                 return a->col > b->col ? 1 : -1;      return a->col > b->col ? 1 : -1;
         else {    else {
                 row = a->row; col = a->col;      row = a->row; col = a->col;
                 for ( i = 0; i < row; i++ )      for ( i = 0; i < row; i++ )
                         for ( j = 0; j < col; j++ )        for ( j = 0; j < col; j++ )
                                 if ( t = compr(vl,(Obj)BDY(a)[i][j],(Obj)BDY(b)[i][j]) )          if ( t = arf_comp(vl,(Obj)BDY(a)[i][j],(Obj)BDY(b)[i][j]) )
                                         return t;            return t;
                 return 0;      return 0;
         }    }
 }  }
   
 pointer **almat_pointer(n,m)  pointer **almat_pointer(n,m)
 int n,m;  int n,m;
 {  {
         pointer **mat;    pointer **mat;
         int i;    int i;
   
         mat = (pointer **)MALLOC(n*sizeof(pointer *));    mat = (pointer **)MALLOC(n*sizeof(pointer *));
         for ( i = 0; i < n; i++ )    for ( i = 0; i < n; i++ )
                 mat[i] = (pointer *)CALLOC(m,sizeof(pointer));      mat[i] = (pointer *)CALLOC(m,sizeof(pointer));
         return mat;    return mat;
 }  }

Legend:
Removed from v.1.4  
changed lines
  Added in v.1.17

FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>