/
tpt-math.cpp
95 lines (78 loc) · 1.14 KB
/
tpt-math.cpp
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
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
#include <cmath>
#include "tpt-math.h"
#include "TrigTables.h"
/**
* Fast trig functions, using lookup table
* Only use for things that require no accuracy, like cyclone tool
* Do not use for any core simulation stuff
*/
float orig_atan(float val)
{
return atan(val);
}
namespace tpt
{
float sin(float angle)
{
angle *= 81.4873;
int i = (int)angle % 512;
if (i < 0)
{
i += 512;
}
return sineLookupTable[i];
}
float cos(float angle)
{
angle *= 81.4873;
int i = (int)angle % 512;
if (i < 0)
{
i += 512;
}
return cosineLookupTable[i];
}
float tan(float angle)
{
angle *= 81.4873;
int i = (int)angle % 512;
if (i < 0)
{
i += 512;
}
return tanLookupTable[i];
}
float atan(float ratio)
{
if (ratio > 20)
{
return orig_atan(ratio);
}
if (ratio < -20)
{
return orig_atan(ratio);
}
return atanLookupTable[(int)(ratio * 100) + 2000];
}
float atan2(float y, float x)
{
if (x > 0)
{
return tpt::atan(y / x);
}
else if (x < 0)
{
if (y >= 0)
{
return tpt::atan(y / x) + M_PI;
}
return tpt::atan(y / x) - M_PI;
}
else if (y > 0)
return M_PI_2;
else if (y < 0)
return M_PI_2;
else
return 0.0f;
}
}