summaryrefslogtreecommitdiff
path: root/src/libultra_code_O2/rotate.c
diff options
context:
space:
mode:
authorRandom <28494085+Random06457@users.noreply.github.com>2020-10-03 17:22:44 +0200
committerGitHub <noreply@github.com>2020-10-03 11:22:44 -0400
commit174af7384d1cfcbf15da02d9069bf02bdc433c20 (patch)
treee4fb18346f71047c123ec4d34a80ae7e4d8ab9ea /src/libultra_code_O2/rotate.c
parent6136ee6debd570a63fc695a6f4664553303f2324 (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.c50
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);
+}