From 168a16b70a928ed64061bdac7fc9d52235c3f9fc Mon Sep 17 00:00:00 2001 From: rodri Date: Thu, 20 Feb 2020 22:02:08 +0000 Subject: git release. --- matrix.c | 74 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 74 insertions(+) create mode 100644 matrix.c (limited to 'matrix.c') diff --git a/matrix.c b/matrix.c new file mode 100644 index 0000000..12956a7 --- /dev/null +++ b/matrix.c @@ -0,0 +1,74 @@ +#include +#include +#include "dat.h" +#include "fns.h" + +void +addm(Matrix a, Matrix b) +{ + int i, j; + + for(i = 0; i < 3; i++) + for(j = 0; j < 3; j++) + a[i][j] += b[i][j]; +} + +void +subm(Matrix a, Matrix b) +{ + int i, j; + + for(i = 0; i < 3; i++) + for(j = 0; j < 3; j++) + a[i][j] -= b[i][j]; +} + +void +mulm(Matrix a, Matrix b) +{ + int i, j, k; + Matrix r; + + for(i = 0; i < 3; i++) + for(j = 0; j < 3; j++){ + r[i][j] = 0; + for(k = 0; k < 3; k++) + r[i][j] += a[i][k]*b[k][j]; + } + for(i = 0; i < 3; i++) + for(j = 0; j < 3; j++) + a[i][j] = r[i][j]; +} + +void +transm(Matrix m) +{ + int i, j; + double tmp; + + for(i = 0; i < 3; i++) + for(j = i; j < 3; j++){ + tmp = m[i][j]; + m[i][j] = m[j][i]; + m[j][i] = tmp; + } +} + +double +detm(Matrix m) +{ + return m[0][0]*(m[1][1]*m[2][2] - m[1][2]*m[2][1]) + + m[0][1]*(m[1][2]*m[2][0] - m[1][0]*m[2][2]) + + m[0][2]*(m[1][0]*m[2][1] - m[1][1]*m[2][0]); +} + +Vector +mulvecm(Vector v, Matrix m) +{ + Vector r; + + r.x = v.x * m[0][0] + v.y * m[0][1] + v.w * m[0][2]; + r.y = v.x * m[1][0] + v.y * m[1][1] + v.w * m[1][2]; + r.w = v.x * m[2][0] + v.y * m[2][1] + v.w * m[2][2]; + return r; +} -- cgit v1.2.3