mirror of https://github.com/zeldaret/tp.git
137 lines
3.3 KiB
C++
137 lines
3.3 KiB
C++
#ifndef JMATRIGONOMETRIC_H
|
|
#define JMATRIGONOMETRIC_H
|
|
|
|
#include "dolphin/types.h"
|
|
#include "utility.h"
|
|
|
|
template<typename T>
|
|
struct TAngleConstant_;
|
|
|
|
/**
|
|
* @ingroup jsystem-jmath
|
|
*
|
|
*/
|
|
template<>
|
|
struct TAngleConstant_<f32> {
|
|
static f32 RADIAN_DEG090() { return 1.5707964f; }
|
|
static f32 RADIAN_DEG180() { return 3.1415927f; }
|
|
static f32 RADIAN_DEG360() { return 6.2831855f; }
|
|
static f32 RADIAN_TO_DEGREE_FACTOR() { return 180.0f / RADIAN_DEG180(); }
|
|
};
|
|
|
|
namespace JMath {
|
|
/**
|
|
* @ingroup jsystem-jmath
|
|
*
|
|
*/
|
|
template<int N, typename T>
|
|
struct TSinCosTable {
|
|
std::pair<T, T> table[1 << N];
|
|
|
|
T sinShort(s16 v) const { return table[(u16)v >> (16U - N)].first; }
|
|
T cosShort(s16 v) const { return table[(u16)v >> (16U - N)].second; }
|
|
|
|
inline T sinLap(T v) {
|
|
if (v < (T)0.0) {
|
|
return -table[(u16)(-(T)(1 << N) * v) & ((1 << N) - 1)].first;
|
|
}
|
|
return table[(u16)((T)(1 << N) * v) & ((1 << N) - 1)].first;
|
|
}
|
|
|
|
inline T sinDegree(T degree) {
|
|
if (degree < (T)0.0) {
|
|
return -table[(u16)(-((T)(1 << N) / (T)360.0) * degree) & ((1 << N) - 1)].first;
|
|
}
|
|
return table[(u16)(((T)(1 << N) / (T)360.0) * degree) & ((1 << N) - 1)].first;
|
|
}
|
|
|
|
inline T cosDegree(T degree) {
|
|
if (degree < (T)0.0) {
|
|
degree = -degree;
|
|
}
|
|
return table[(u16)(((T)(1 << N) / (T)360.0) * degree) & ((1 << N) - 1)].second;
|
|
}
|
|
|
|
inline T sinRadian(T radian) {
|
|
if (radian < (T)0.0) {
|
|
return -table[(u16)(-(T)(1 << N) / TAngleConstant_<T>::RADIAN_DEG360() * radian) & ((1 << N) - 1)].first;
|
|
}
|
|
return table[(u16)((T)(1 << N) / TAngleConstant_<T>::RADIAN_DEG360() * radian) & ((1 << N) - 1)].first;
|
|
}
|
|
};
|
|
|
|
/**
|
|
* @ingroup jsystem-jmath
|
|
*
|
|
*/
|
|
struct TAtanTable {
|
|
f32 table[1025];
|
|
u8 pad[0x1C];
|
|
};
|
|
|
|
/**
|
|
* @ingroup jsystem-jmath
|
|
*
|
|
*/
|
|
struct TAsinAcosTable {
|
|
f32 table[1025];
|
|
u8 pad[0x1C];
|
|
|
|
f32 acos_(f32 x) {
|
|
if (x >= 1.0f) {
|
|
return 0.0f;
|
|
} else if (x <= -1.0f) {
|
|
return TAngleConstant_<f32>::RADIAN_DEG180();
|
|
} else if (x < 0.0f) {
|
|
return table[(u32)(-x * 1023.5f)] + TAngleConstant_<f32>::RADIAN_DEG090();
|
|
} else {
|
|
return TAngleConstant_<f32>::RADIAN_DEG090() - table[(u32)(x * 1023.5f)];
|
|
}
|
|
}
|
|
|
|
f32 acosDegree(f32 x) {
|
|
return acos_(x) * TAngleConstant_<f32>::RADIAN_TO_DEGREE_FACTOR();
|
|
}
|
|
};
|
|
|
|
extern TSinCosTable<13, f32> sincosTable_;
|
|
extern TAtanTable atanTable_;
|
|
extern TAsinAcosTable asinAcosTable_;
|
|
|
|
inline f32 acosDegree(f32 x) {
|
|
return asinAcosTable_.acosDegree(x);
|
|
}
|
|
}; // 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 */
|