diff --git a/src/main/java/frc4388/robot/subsystems/Arm.java b/src/main/java/frc4388/robot/subsystems/Arm.java index 10663c3..6367d4d 100644 --- a/src/main/java/frc4388/robot/subsystems/Arm.java +++ b/src/main/java/frc4388/robot/subsystems/Arm.java @@ -22,13 +22,13 @@ public class Arm extends SubsystemBase { public void armSetLength(double len) { if (len > 1 || len < 0) return; // Move arm code - m_armmotor.set(ControlMode.Position, len * (ArmConstants.maxArmLen - ArmConstants.minArmLen) + - ArmConstants.minArmLen); + m_armmotor.set(ControlMode.Position, len * (ArmConstants.MAX_ARM_LEN - ArmConstants.MIN_ARM_LEN) + + ArmConstants.MIN_ARM_LEN); } public double getArmLength() { - return (m_armmotor.getSelectedSensorPosition() - ArmConstants.minArmLen) / - (ArmConstants.maxArmLen - ArmConstants.minArmLen); + return (m_armmotor.getSelectedSensorPosition() - ArmConstants.MIN_ARM_LEN) / + (ArmConstants.MAX_ARM_LEN - ArmConstants.MIN_ARM_LEN); } @Override @@ -36,4 +36,4 @@ public class Arm extends SubsystemBase { if (m_debug) SmartDashboard.putNumber("Arm Motor", m_armmotor.getSelectedSensorPosition()); } -} \ No newline at end of file +}