blob: 12956a7e1848c35c2e3e50afc5c9ff7a25b64733 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
|
#include <u.h>
#include <libc.h>
#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;
}
|