1 files changed, 89 insertions, 0 deletions
diff --git a/src/gamepad.rs b/src/gamepad.rs
new file mode 100644
index 0000000..8f05333
--- /dev/null
+++ b/src/gamepad.rs
@@ -0,0 +1,89 @@
+use crate::state::GBState;
+use gilrs::{Button, GamepadId, Gilrs, Event};
+
+pub struct Gamepad {
+    gilrs: Gilrs,
+    gamepad_id: Option<GamepadId>,
+}
+
+impl Gamepad {
+    pub fn new() -> Self {
+        let mut gilrs = Gilrs::new().unwrap();
+
+        let gamepad_id = if let Some((gamepad_id, _gamepad)) = gilrs.gamepads().next() {
+            println!("Found Gamepad id: {:?}", gamepad_id);
+            Some(gamepad_id)
+        } else {
+            println!("No gamepad found");
+            None
+        };
+
+
+        Self { gilrs, gamepad_id }
+    }
+
+    pub fn update_events(&mut self) {
+        while let Some(_) = self.gilrs.next_event() {}
+    }
+
+    pub fn check_special_actions(&self, state: &mut GBState) {
+        if let Some(gamepad_id) = self.gamepad_id {
+            if let Some(gamepad) = self.gilrs.connected_gamepad(gamepad_id) {
+                state.is_debug = gamepad.is_pressed(Button::West);
+            }
+        }
+    }
+
+    pub fn get_action_gamepad_reg(&self) -> u8 {
+
+        let mut res = 0xf;
+
+        if let Some(gamepad_id) = self.gamepad_id {
+            if let Some(gamepad) = self.gilrs.connected_gamepad(gamepad_id) {
+                if gamepad.is_pressed(Button::East) {
+                    res &= 0b1110;
+                }
+
+                if gamepad.is_pressed(Button::South) {
+                    res &= 0b1101;
+                }
+
+                if gamepad.is_pressed(Button::Select) {
+                    res &= 0b1011;
+                }
+
+                if gamepad.is_pressed(Button::Start) {
+                    res &= 0b0111;
+                }
+            }
+        }
+
+        res
+    }
+
+    pub fn get_direction_gamepad_reg(&self) -> u8 {
+        let mut res = 0xf;
+
+        if let Some(gamepad_id) = self.gamepad_id {
+            if let Some(gamepad) = self.gilrs.connected_gamepad(gamepad_id) {
+                if gamepad.is_pressed(Button::DPadRight) {
+                    res &= 0b1110;
+                }
+
+                if gamepad.is_pressed(Button::DPadLeft) {
+                    res &= 0b1101;
+                }
+
+                if gamepad.is_pressed(Button::DPadUp) {
+                    res &= 0b1011;
+                }
+
+                if gamepad.is_pressed(Button::DPadDown) {
+                    res &= 0b0111;
+                }
+            }
+        }
+
+        res
+    }
+}