padutils.c (#34)

1 files changed, 92 insertions, 0 deletions

diff --git a/src/boot/O2/padutils.c b/src/boot/O2/padutils.c
new file mode 100644
index 0000000..73745ac
--- /dev/null
+++ b/src/boot/O2/padutils.c
@@ -0,0 +1,92 @@
+#include "padutils.h"
+
+void pad_init(Input* input) {
+    bzero(input, sizeof(Input));
+}
+
+void pad_cleanup(void) {
+}
+
+void pad_flush(Input* input) {
+    input->press.button = 0;
+    input->rel.button = 0;
+}
+
+s32 pad_push_only(Input* input, u16 value) {
+    return value == input->cur.button;
+}
+
+s32 pad_push_also(Input* input, u16 key) {
+    return key == (input->cur.button & key);
+}
+
+s32 pad_on_trigger(Input* input, u16 key) {
+    return key == (input->press.button & key);
+}
+
+s32 pad_off_trigger(Input* input, u16 key) {
+    return key == (input->rel.button & key);
+}
+
+u16 pad_button(Input* input) {
+    return input->cur.button;
+}
+
+u16 pad_trigger(Input* input) {
+    return input->press.button;
+}
+
+s8 pad_physical_stick_x(Input* input) {
+    return input->cur.stick_x;
+}
+
+s8 pad_physical_stick_y(Input* input) {
+    return input->cur.stick_y;
+}
+
+void pad_set_logical_stick(Input* input, s32 x, s32 y) {
+    input->rel.stick_x = x;
+    input->rel.stick_y = y;
+}
+
+s8 pad_logical_stick_x(Input* input) {
+    return input->rel.stick_x;
+}
+
+s8 pad_logical_stick_y(Input* input) {
+    return input->rel.stick_y;
+}
+
+s8 pad_stick_x(Input* input) {
+    return pad_logical_stick_x(input);
+}
+
+s8 pad_stick_y(Input* input) {
+    return pad_logical_stick_y(input);
+}
+
+void pad_correct_stick(Input* input) {
+    s32 curX = pad_physical_stick_x(input);
+    s32 curY = pad_physical_stick_y(input);
+    s32 relX;
+    s32 relY;
+
+    if (curX > 7) {
+        relX = (curX < 0x43) ? curX - 7 : 0x43 - 7;
+    } else if (curX < -7) {
+        relX = (curX > -0x43) ? curX + 7 : -0x43 + 7;
+    } else {
+        relX = 0;
+    }
+
+    if (curY > 7) {
+        relY = (curY < 0x43) ? curY - 7 : 0x43 - 7;
+
+    } else if (curY < -7) {
+        relY = (curY > -0x43) ? curY + 7 : -0x43 + 7;
+    } else {
+        relY = 0;
+    }
+
+    pad_set_logical_stick(input, relX, relY);
+}