#include "common.h"
#include "vector.h"

void make_identity_matrix(float *imatrix, int n)
{
     int i,j;

     for (i=0; i<=n-1; i++)
     {
          for (j=0; j<=n-1; j++)  (*(imatrix + n * i + j)) = 0.0;
          (*(imatrix + n * i + i)) = 1.0;
     }
}

void matrix_mult(float *c, float *a, float *b, int m, int n, int p) /* c=a*b */
{
   int i, j, k;   /* cik = aij bjk */
   double x;

   for (i=0; i<m; i++)
   {
      for (k=0; k<p; k++)
      {
         for (j=0, x=0.0; j<n; j++)  x += *(a+i*n+j) * *(b+j*p+k);
         *(c+i*p+k) = x;
      }
   }
   return;
}