diff --git a/src/main/java/org/carlmontrobotics/subsystems/Arm.java b/src/main/java/org/carlmontrobotics/subsystems/Arm.java index 50f27f42..65e305c7 100644 --- a/src/main/java/org/carlmontrobotics/subsystems/Arm.java +++ b/src/main/java/org/carlmontrobotics/subsystems/Arm.java @@ -101,7 +101,7 @@ public Arm() { armPIDMaster.setFeedbackDevice(armMasterEncoder); armPIDMaster.setPositionPIDWrappingEnabled(true); armPIDMaster.setPositionPIDWrappingMinInput(MathUtil.angleModulus(LOWER_ANGLE_LIMIT)); - armPIDMaster.setPositionPIDWrappingMaxInput(MathUtil.angleModulus(LOWER_ANGLE_LIMIT)); + armPIDMaster.setPositionPIDWrappingMaxInput(MathUtil.angleModulus(UPPER_ANGLE_LIMIT)); //two PIDs? armPIDFollower.setFeedbackDevice(armMotorFollower.getEncoder()); armPIDFollower.setPositionPIDWrappingEnabled(true);