From 6b29cd69cf62c3e9e838196f7ca0a10f9f9ed0c5 Mon Sep 17 00:00:00 2001 From: Brandon Date: Sun, 3 Mar 2024 10:37:08 -0800 Subject: [PATCH] undo bad stuff I did --- src/main/java/org/carlmontrobotics/subsystems/Arm.java | 8 ++++---- 1 file changed, 4 insertions(+), 4 deletions(-) diff --git a/src/main/java/org/carlmontrobotics/subsystems/Arm.java b/src/main/java/org/carlmontrobotics/subsystems/Arm.java index 65e305c7..ae51634d 100644 --- a/src/main/java/org/carlmontrobotics/subsystems/Arm.java +++ b/src/main/java/org/carlmontrobotics/subsystems/Arm.java @@ -100,13 +100,13 @@ public Arm() { armPIDMaster.setFeedbackDevice(armMasterEncoder); armPIDMaster.setPositionPIDWrappingEnabled(true); - armPIDMaster.setPositionPIDWrappingMinInput(MathUtil.angleModulus(LOWER_ANGLE_LIMIT)); - armPIDMaster.setPositionPIDWrappingMaxInput(MathUtil.angleModulus(UPPER_ANGLE_LIMIT)); + armPIDMaster.setPositionPIDWrappingMinInput(LOWER_ANGLE_LIMIT); + armPIDMaster.setPositionPIDWrappingMaxInput(UPPER_ANGLE_LIMIT); //two PIDs? armPIDFollower.setFeedbackDevice(armMotorFollower.getEncoder()); armPIDFollower.setPositionPIDWrappingEnabled(true); - armPIDFollower.setPositionPIDWrappingMinInput(LOWER_ANGLE_LIMIT); - armPIDFollower.setPositionPIDWrappingMaxInput(UPPER_ANGLE_LIMIT); + armPIDFollower.setPositionPIDWrappingMinInput(MathUtil.angleModulus(LOWER_ANGLE_LIMIT)); + armPIDFollower.setPositionPIDWrappingMaxInput(MathUtil.angleModulus(UPPER_ANGLE_LIMIT)); SmartDashboard.putData("Arm", this);