//
// mops.h --- block matrix operations
//
// Copyright (C) 1997 Limit Point Systems, Inc.
//
// Author: Edward Seidl <seidl@janed.com>
// Maintainer: LPS
//
// This file is part of the SC Toolkit.
//
// The SC Toolkit is free software; you can redistribute it and/or modify
// it under the terms of the GNU Library General Public License as published by
// the Free Software Foundation; either version 2, or (at your option)
// any later version.
//
// The SC Toolkit is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
// GNU Library General Public License for more details.
//
// You should have received a copy of the GNU Library General Public License
// along with the SC Toolkit; see the file COPYING.LIB.  If not, write to
// the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
//
// The U.S. Government is granted a limited license as per AL 91-7.
//

#ifndef _math_scmat_mops_h
#define _math_scmat_mops_h

#define D1 32

// copy a chunk of rectangular matrix source into dest.  dest is D1xD1, and is
// padded with zeros

static inline void
copy_block(double **dest, double **source,
           int istart, int ni, int jstart, int nj)
{
  int ii,jj;
  
  for (ii=0; ii < ni; ii++) {
    double *di = dest[ii];
    double *si = &source[istart+ii][jstart];
    for (jj=0; jj < nj; jj++)
      di[jj] = si[jj];
    for (; jj < D1; jj++)
      di[jj] = 0;
  }

  int left=D1-ii;
  if (left)
    memset(dest[ii], 0, sizeof(double)*left*D1);
}

static inline void
copy_trans_block(double **dest, double **source,
                 int istart, int ni, int jstart, int nj)
{
  int ii,jj;
  
  memset(dest[0], 0, sizeof(double)*D1*D1);

  for (jj=0; jj < nj; jj++) {
    double *sj = &source[jstart+jj][istart];
    for (ii=0; ii < ni; ii++)
      dest[ii][jj] = sj[ii];
  }
}

// copy a chunk of symmetric matrix source into dest.  dest is D1xD1, and is
// padded with zeros
static inline void
copy_sym_block(double **dest, double **source,
               int istart, int ni, int jstart, int nj)
{
  int ii,jj;

  for (ii=0; ii < ni; ii++) {
    double *di = dest[ii];
    double *si = &source[istart+ii][jstart];
    
    if (jstart < istart)
      for (jj=0; jj < nj; jj++)
        di[jj] = si[jj];
    else if (jstart==istart)
      for (jj=0; jj <= ii; jj++)
        di[jj] = dest[jj][ii] = si[jj];
    else
      for (jj=0; jj < nj; jj++)
        di[jj] = source[jstart+jj][istart+ii];

    for (jj=nj; jj < D1; jj++)
      di[jj] = 0;
  }

  int left=D1-ii;
  if (left)
    memset(dest[ii], 0, sizeof(double)*left*D1);
}

static inline void
return_block(double **dest, double **source,
             int istart, int ni, int jstart, int nj)
{
  int ii,jj;

  for (ii=0; ii < ni; ii++)
    for (jj=0; jj < nj; jj++)
      dest[istart+ii][jstart+jj] = source[ii][jj];
}

// a, b, and c are all D1xD1 blocks
static inline void
mult_block(double **a, double **b, double **c, int ni, int nj, int nk)
{
  int ii,jj,kk;
  double t00,t10,t20,t30;
  double *a0, *a1, *a2, *a3;
  double *c0, *c1, *c2, *c3;

  for (ii=0; ii < ni; ii += 4) {
    a0=a[ii]; a1=a[ii+1]; a2=a[ii+2]; a3=a[ii+3];
    c0=c[ii]; c1=c[ii+1]; c2=c[ii+2]; c3=c[ii+3];

    for (jj=0; jj < nj; jj++) {
      double *bt = b[jj];
      t00=c0[jj]; t10=c1[jj]; t20=c2[jj]; t30=c3[jj];

      for (kk=0; kk < nk; kk += 2) {
        register double b0=bt[kk], b1=bt[kk+1];
        t00 += a0[kk]*b0 + a0[kk+1]*b1;
        t10 += a1[kk]*b0 + a1[kk+1]*b1;
        t20 += a2[kk]*b0 + a2[kk+1]*b1;
        t30 += a3[kk]*b0 + a3[kk+1]*b1;
      }

      c0[jj]=t00;
      c1[jj]=t10;
      c2[jj]=t20;
      c3[jj]=t30;
    }
  }
}

#endif

// Local Variables:
// mode: c++
// c-file-style: "ETS"
// End: