mirror of https://github.com/zeldaret/tp.git
97 lines
2.3 KiB
C++
97 lines
2.3 KiB
C++
#ifndef JMATRIGONOMETRIC_H
|
|
#define JMATRIGONOMETRIC_H
|
|
|
|
#include "dolphin/types.h"
|
|
#include "utility.h"
|
|
|
|
template<typename T>
|
|
struct TAngleConstant_;
|
|
|
|
template<>
|
|
struct TAngleConstant_<f32> {
|
|
static inline f32 RADIAN_DEG360() { return 6.2831855f; }
|
|
};
|
|
|
|
struct TSinCosTable {
|
|
std::pair<f32, f32> table[0x2000];
|
|
|
|
f32 sinShort(s16 v) const { return table[(u16)v >> 3U].first; }
|
|
f32 cosShort(s16 v) const { return table[(u16)v >> 3U].second; }
|
|
|
|
inline f32 sinLap(f32 v) {
|
|
if (v < 0.0f) {
|
|
return -table[(u16)(-8192.0f * v) & 0x1fff].first;
|
|
}
|
|
return table[(u16)(8192.0f * v) & 0x1fff].first;
|
|
}
|
|
|
|
inline f32 sinDegree(f32 degree) {
|
|
if (degree < 0.0f) {
|
|
return -table[(u16)(-22.755556106567383f * degree) & 0x1fffU].first;
|
|
}
|
|
return table[(u16)(22.755556106567383f * degree) & 0x1fffU].first;
|
|
}
|
|
|
|
inline f32 cosDegree(f32 degree) {
|
|
if (degree < 0.0f) {
|
|
degree = -degree;
|
|
}
|
|
return table[(u16)(22.755556106567383f * degree) & 0x1fffU].second;
|
|
}
|
|
|
|
inline f32 sinRadian(f32 radian) {
|
|
if (radian < 0.0f) {
|
|
return -table[(u16)(-8192.0f / TAngleConstant_<f32>::RADIAN_DEG360() * radian) & 0x1fffU].first;
|
|
}
|
|
return table[(u16)(8192.0f / TAngleConstant_<f32>::RADIAN_DEG360() * radian) & 0x1fffU].first;
|
|
}
|
|
};
|
|
|
|
struct TAtanTable {
|
|
f32 table[1025];
|
|
u8 pad[0x1C];
|
|
};
|
|
|
|
struct TAsinAcosTable {
|
|
f32 table[1025];
|
|
u8 pad[0x1C];
|
|
};
|
|
|
|
namespace JMath {
|
|
extern TSinCosTable sincosTable_;
|
|
extern TAtanTable atanTable_;
|
|
extern TAsinAcosTable asinAcosTable_;
|
|
}; // namespace JMath
|
|
|
|
inline f32 JMASCosShort(s16 v) {
|
|
return JMath::sincosTable_.cosShort(v);
|
|
}
|
|
inline f32 JMASinShort(s16 v) {
|
|
return JMath::sincosTable_.sinShort(v);
|
|
}
|
|
|
|
inline f32 JMASCos(s16 v) {
|
|
return JMASCosShort(v);
|
|
}
|
|
inline f32 JMASSin(s16 v) {
|
|
return JMASinShort(v);
|
|
}
|
|
|
|
inline f32 JMASinLap(f32 v) {
|
|
return JMath::sincosTable_.sinLap(v);
|
|
}
|
|
|
|
inline f32 JMASinDegree(f32 degree) {
|
|
return JMath::sincosTable_.sinDegree(degree);
|
|
}
|
|
|
|
inline f32 JMACosDegree(f32 degree) {
|
|
return JMath::sincosTable_.cosDegree(degree);
|
|
}
|
|
|
|
inline f32 JMASinRadian(f32 radian) {
|
|
return JMath::sincosTable_.sinRadian(radian);
|
|
}
|
|
|
|
#endif /* JMATRIGONOMETRIC_H */
|