diff --git a/src/main/java/org/carlmontrobotics/RobotContainer.java b/src/main/java/org/carlmontrobotics/RobotContainer.java index 0657dc65..ed4f8c2a 100644 --- a/src/main/java/org/carlmontrobotics/RobotContainer.java +++ b/src/main/java/org/carlmontrobotics/RobotContainer.java @@ -59,7 +59,8 @@ private void setDefaultCommands() { // () -> driverController.getRawButton(OI.Driver.slowDriveButton) // )); - arm.setDefaultCommand(new ArmTeleop(arm, () -> inputProcessing(getStickValue(manipulatorController, Axis.kLeftY)))); + arm.setDefaultCommand(new ArmTeleop(arm, + () -> DeadzonedAxis(inputProcessing(getStickValue(manipulatorController, Axis.kLeftY))))); } private void setBindingsDriver() { @@ -158,4 +159,17 @@ private double inputProcessing(double value) { private double ProcessedAxisValue(GenericHID hid, Axis axis) { return inputProcessing(getStickValue(hid, axis)); } + + /** + * Returns zero if a axis input is inside the deadzone + * + * @param hid The controller/plane joystick the axis is on + * @param axis The processed axis + * @return The processed value. + */ + private double DeadzonedAxis(double axOut) { + return (-OI.JOY_THRESH < axOut && axOut < OI.JOY_THRESH) ? 0.0 : axOut; + } + + }