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
|
#include <math.h>
#include <stdio.h>
#include "vector.h"
v32 make_v32(f32 x, f32 y, f32 z)
{
v32 v;
v.x = x;
v.y = y;
v.z = z;
return v;
}
v32 vmul(f32 s, v32 v)
{
v32 r = { s * v.x, s * v.y, s * v.z};
return r;
}
v32 vadd(v32 a, v32 b)
{
v32 v = { a.x + b.x, a.y + b.y, a.z + b.z};
return v;
}
v32 vsub(v32 a, v32 b)
{
v32 v = { a.x - b.x, a.y - b.y, a.z - b.z};
return v;
}
f32 vdot(v32 a, v32 b)
{
return a.x * b.x + a.y * b.y + a.z * b.z;
}
f32 vlength(v32 v)
{
return sqrtf(vdot(v, v));
}
v32 vunitise(v32 v)
{
f32 l = vlength(v);
if(l == 0.0) {
fprintf(stderr, "vunitise: vlength==0\n");
return v;
} else {
return vmul(1.0 / l, v);
}
}
|
