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
|
//
// Generated by dtk
// Translation Unit: JMath.cpp
//
#include "JSystem/JSystem.h" // IWYU pragma: keep
#include "JSystem/JMath/JMath.h"
#include "JSystem/JMath/JMATrigonometric.h"
#include "math.h"
#include "dolphin/types.h"
u16 jmaSinTableSize;
u32 jmaSinShift;
f32* jmaSinTable;
f32* jmaCosTable;
/* 80301028-80301150 .text JMANewSinTable__FUc */
bool JMANewSinTable(u8 numBits) {
jmaSinShift = 16 - numBits;
jmaSinTableSize = 1;
for (u8 i = 0; i < numBits; i++) {
jmaSinTableSize *= 2;
}
jmaSinTable = new f32[jmaSinTableSize + (jmaSinTableSize / 4)];
if (!jmaSinTable) {
return false;
}
for (u16 i = 0; i < jmaSinTableSize + (jmaSinTableSize / 4); i++) {
jmaSinTable[i] = sin(((M_PI * 2.0f) / jmaSinTableSize) * i);
}
jmaCosTable = jmaSinTable + (jmaSinTableSize / 4);
return true;
}
/* 80301150-80301218 .text JMAEulerToQuat__FsssP10Quaternion */
void JMAEulerToQuat(s16 x, s16 y, s16 z, Quaternion* out) {
f32 cos_0 = JMASCos(x / 2);
f32 cos_1 = JMASCos(y / 2);
f32 cos_2 = JMASCos(z / 2);
f32 sin_0 = JMASSin(x / 2);
f32 sin_1 = JMASSin(y / 2);
f32 sin_2 = JMASSin(z / 2);
f32 c1_c2 = cos_1 * cos_2;
f32 s1_s2 = sin_1 * sin_2;
out->w = (cos_0 * c1_c2) + (sin_0 * s1_s2);
out->x = (sin_0 * c1_c2) - (cos_0 * s1_s2);
out->y = (cos_2 * (cos_0 * sin_1)) + (sin_2 * (sin_0 * cos_1));
out->z = (sin_2 * (cos_0 * cos_1)) - (cos_2 * (sin_0 * sin_1));
}
/* 80301218-803012D8 .text JMAQuatLerp__FP10QuaternionP10QuaternionfP10Quaternion */
void JMAQuatLerp(Quaternion* a, Quaternion* b, f32 t, Quaternion* out) {
Quaternion temp;
f32 dot = (a->x * b->x) + (a->y * b->y) + (a->z * b->z) + (a->w * b->w);
if (dot < 0.0) {
temp.x = -b->x;
temp.y = -b->y;
temp.z = -b->z;
temp.w = -b->w;
} else {
temp.x = b->x;
temp.y = b->y;
temp.z = b->z;
temp.w = b->w;
}
out->x = (1.0 - t) * a->x + (f64)t * temp.x;
out->y = (1.0 - t) * a->y + (f64)t * temp.y;
out->z = (1.0 - t) * a->z + (f64)t * temp.z;
out->w = (1.0 - t) * a->w + (f64)t * temp.w;
}
/* 803012D8-80301350 .text JMAHermiteInterpolation__Ffffffff */
f32 JMAHermiteInterpolation(f32 frame, f32 time0, f32 value0, f32 tangent0, f32 time1, f32 value1, f32 tangent1) {
f32 length = time1 - time0;
f32 f9 = frame - time0;
f32 f1 = 1.0f / length;
f32 f2 = f9 * f9 * f1;
f32 f10 = f2 * f1;
f32 f11 = f9 * f10;
f32 f12 = f11 * f1;
return (value0 * ((1.0f + ((2.0f * f12) - (3.0f * f10))))) +
(value1 * ((-2.0f * f12) + (3.0f * f10))) +
(tangent0 * (f9 + (f11 - (2.0f * f2)))) +
(tangent1 * (f11 - f2));
}
|
