| 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 | |