Update Hood.java

diff --git a/src/main/java/frc/robot/subsystems/hood/Hood.java b/src/main/java/frc/robot/subsystems/hood/Hood.java
index fa8b6fc1f0f638e19b15b266af5236ed960461ba..f6e4d73bd909e808c9a36afc590f1dddc3b475b0 100644 (file)
--- a/src/main/java/frc/robot/subsystems/hood/Hood.java
+++ b/src/main/java/frc/robot/subsystems/hood/Hood.java
@@ -70,7 +70,7 @@ public class Hood extends SubsystemBase implements HoodIO{
                                        }
                                });
 
-        setpoint = new State(getPositionRad(), 0.0);
+        setpoint = new State(getPositionRad() / GEAR_RATIO, 0.0);
 
                SmartDashboard.putData("max", new InstantCommand(() -> setFieldRelativeTarget(new Rotation2d(Units.degreesToRadians(HoodConstants.MAX_ANGLE)), 0)));
                SmartDashboard.putData("medium", new InstantCommand(() -> setFieldRelativeTarget(new Rotation2d(Units.degreesToRadians((HoodConstants.MAX_ANGLE + HoodConstants.MIN_ANGLE) / 2)), 0)));