From a93eb025f18806c60f7f8f2b60c372b3eb52f3f2 Mon Sep 17 00:00:00 2001
From: Aarav Shah <aaravshah18@gmail.com>
Date: Sat, 15 Jan 2022 14:22:45 -0700
Subject: [PATCH] Update XboxControllerRaw.java

---
 .../utility/controller/XboxControllerRaw.java | 80 ++++++++++++++++---
 1 file changed, 67 insertions(+), 13 deletions(-)

diff --git a/src/main/java/frc4388/utility/controller/XboxControllerRaw.java b/src/main/java/frc4388/utility/controller/XboxControllerRaw.java
index 00cdcce..649cc7e 100644
--- a/src/main/java/frc4388/utility/controller/XboxControllerRaw.java
+++ b/src/main/java/frc4388/utility/controller/XboxControllerRaw.java
@@ -1,20 +1,74 @@
-// package frc4388.utility.controller;
+package frc4388.utility.controller;
+import java.nio.ByteBuffer;
+import edu.wpi.first.hal.HAL;
 
-// public class XboxControllerRaw implements IHandController {
-//   int buttons;
-//   public void updateInput() {
-//   }
-//   public double getLeftXAxis() {}
 
-//   public double getLeftYAxis();
+public class XboxControllerRaw implements IHandController {
+    public static final int LEFT_X_AXIS = 0;
+    public static final int LEFT_Y_AXIS = 1;
+    public static final int LEFT_TRIGGER_AXIS = 2;
+    public static final int RIGHT_TRIGGER_AXIS = 3;
+    public static final int RIGHT_X_AXIS = 4;
+    public static final int RIGHT_Y_AXIS = 5;
+    public static final int LEFT_RIGHT_DPAD_AXIS = 6;
+    public static final int TOP_BOTTOM_DPAD_AXIS = 6;
+  
+    public static final int A_BUTTON = 0;
+    public static final int B_BUTTON = 1;
+    public static final int X_BUTTON = 2;
+    public static final int Y_BUTTON = 3;
+    public static final int LEFT_BUMPER_BUTTON = 4;
+    public static final int RIGHT_BUMPER_BUTTON = 5;
+    public static final int BACK_BUTTON = 6;
+    public static final int START_BUTTON = 7;
+  
+    public static final int LEFT_JOYSTICK_BUTTON = 8;
+    public static final int RIGHT_JOYSTICK_BUTTON = 9;
 
-//   public double getRightXAxis();
+  private int m_buttons = 0;
+  private int m_numButtons;
+  private ByteBuffer m_buttonCountBuffer = ByteBuffer.allocateDirect(1);
+  float[] m_axes = new float[HAL.kMaxJoystickAxes];
+  public void updateInput() {
+    HAL.getJoystickAxes((byte) 0, m_axes);    
+    m_buttons = HAL.getJoystickButtons((byte) 0, m_buttonCountBuffer);
+    m_numButtons = m_buttonCountBuffer.get(0);
+  }
 
-//   public double getRightYAxis();
+  public int getNumButtons() {
+    return m_numButtons;
+  }
 
-//   public double getLeftTriggerAxis();
+  public boolean getButton(int index) {
+      return (m_buttons & 1 << index) > 0;
+  }
+  public double getLeftXAxis() {
+      return m_axes[LEFT_X_AXIS];
+  }
 
-//   public double getRightTriggerAxis();
+  public double getLeftYAxis() {
+      
+    return m_axes[LEFT_Y_AXIS];
+  }
 
-//   public int getDpadAngle();
-// }
\ No newline at end of file
+  public double getRightXAxis() {
+      
+    return m_axes[RIGHT_X_AXIS];
+  }
+
+  public double getRightYAxis() {
+    return m_axes[RIGHT_Y_AXIS];
+  }
+
+  public double getLeftTriggerAxis() {
+    return m_axes[LEFT_TRIGGER_AXIS];
+  }
+
+  public double getRightTriggerAxis() {
+    return m_axes[RIGHT_TRIGGER_AXIS];
+  }
+
+  public int getDpadAngle() {
+      return -1;
+  }
+}
\ No newline at end of file