source/gles2n64/src/3DMath.cpp

   1 #include <math.h>
   2
   3 static void MultMatrix_default( float m0[4][4], float m1[4][4],
   4         float dest[4][4])
   5 {
   6     int i;
   7     for (i = 0; i < 4; i++)
   8     {
   9         dest[0][i] = m0[0][i]*m1[0][0] + m0[1][i]*m1[0][1] + m0[2][i]*m1[0][2] + m0[3][i]*m1[0][3];
  10         dest[1][i] = m0[0][i]*m1[1][0] + m0[1][i]*m1[1][1] + m0[2][i]*m1[1][2] + m0[3][i]*m1[1][3];
  11         dest[2][i] = m0[0][i]*m1[2][0] + m0[1][i]*m1[2][1] + m0[2][i]*m1[2][2] + m0[3][i]*m1[2][3];
  12         dest[3][i] = m0[3][i]*m1[3][3] + m0[2][i]*m1[3][2] + m0[1][i]*m1[3][1] + m0[0][i]*m1[3][0];
  13     }
  14 }
  15
  16 static void TransformVectorNormalize_default(float vec[3], float mtx[4][4])
  17 {
  18     float len;
  19
  20     vec[0] = mtx[0][0] * vec[0]
  21            + mtx[1][0] * vec[1]
  22            + mtx[2][0] * vec[2];
  23     vec[1] = mtx[0][1] * vec[0]
  24            + mtx[1][1] * vec[1]
  25            + mtx[2][1] * vec[2];
  26     vec[2] = mtx[0][2] * vec[0]
  27            + mtx[1][2] * vec[1]
  28            + mtx[2][2] * vec[2];
  29     len = vec[0]*vec[0] + vec[1]*vec[1] + vec[2]*vec[2];
  30     if (len != 0.0)
  31     {
  32         len = sqrtf(len);
  33         vec[0] /= len;
  34         vec[1] /= len;
  35         vec[2] /= len;
  36     }
  37 }
  38
  39 static void Normalize_default(float v[3])
  40 {
  41     float len;
  42
  43     len = (float)(v[0]*v[0] + v[1]*v[1] + v[2]*v[2]);
  44     if (len != 0.0)
  45     {
  46         len = (float)sqrt( len );
  47         v[0] /= (float)len;
  48         v[1] /= (float)len;
  49         v[2] /= (float)len;
  50     }
  51 }
  52
  53 static float DotProduct_default( float v0[3], float v1[3] )
  54 {
  55     float dot;
  56     dot = v0[0]*v1[0] + v0[1]*v1[1] + v0[2]*v1[2];
  57     return dot;
  58 }
  59
  60
  61 void (*MultMatrix)(float m0[4][4], float m1[4][4], float dest[4][4]) =
  62         MultMatrix_default;
  63 void (*TransformVectorNormalize)(float vec[3], float mtx[4][4]) =
  64         TransformVectorNormalize_default;
  65 void (*Normalize)(float v[3]) = Normalize_default;
  66 float (*DotProduct)(float v0[3], float v1[3]) = DotProduct_default;
  67