diff options
| author | Random <28494085+Random06457@users.noreply.github.com> | 2020-10-03 17:22:44 +0200 |
|---|---|---|
| committer | GitHub <noreply@github.com> | 2020-10-03 11:22:44 -0400 |
| commit | 174af7384d1cfcbf15da02d9069bf02bdc433c20 (patch) | |
| tree | e4fb18346f71047c123ec4d34a80ae7e4d8ab9ea /src/libultra_code_O2/rotate.c | |
| parent | 6136ee6debd570a63fc695a6f4664553303f2324 (diff) | |
libultra cleanup (#215)
* cleanup libultra
* fixes
- use quotes instead of <> for includes
- add macros for zelda specific thread priorities
- fix Makefile
- properly format the remaining pfs structs
* fix button macros + add CHECK_BTN_ANY/CHECK_BTN_ALL
* remove ULTRA_ABS
* fix includes
* update z_player.c/z_lib.c + run format.sh
* merge upstream/master
* fix include in En_Goroiwa
* fix includes
Diffstat (limited to 'src/libultra_code_O2/rotate.c')
| -rw-r--r-- | src/libultra_code_O2/rotate.c | 50 |
1 files changed, 50 insertions, 0 deletions
diff --git a/src/libultra_code_O2/rotate.c b/src/libultra_code_O2/rotate.c new file mode 100644 index 000000000..a3fd9b978 --- /dev/null +++ b/src/libultra_code_O2/rotate.c @@ -0,0 +1,50 @@ +#include "global.h" + +void guRotateF(f32 m[4][4], f32 a, f32 x, f32 y, f32 z) { + static f32 D_80134D10 = M_PI / 180.0f; + f32 sine; + f32 cosine; + f32 ab; + f32 bc; + f32 ca; + f32 t; + f32 xs; + f32 ys; + f32 zs; + + guNormalize(&x, &y, &z); + + a = a * D_80134D10; + + sine = sinf(a); + cosine = cosf(a); + + ab = x * y * (1 - cosine); + bc = y * z * (1 - cosine); + ca = z * x * (1 - cosine); + + guMtxIdentF(m); + + xs = x * sine; + ys = y * sine; + zs = z * sine; + + t = x * x; + m[0][0] = (1 - t) * cosine + t; + m[2][1] = bc - xs; + m[1][2] = bc + xs; + t = y * y; + m[1][1] = (1 - t) * cosine + t; + m[2][0] = ca + ys; + m[0][2] = ca - ys; + t = z * z; + m[2][2] = (1 - t) * cosine + t; + m[1][0] = ab - zs; + m[0][1] = ab + zs; +} + +void guRotate(Mtx* m, f32 a, f32 x, f32 y, f32 z) { + f32 mf[4][4]; + guRotateF(mf, a, x, y, z); + guMtxF2L(mf, m); +} |
