resetGoal finished?

DeepBlueRobotics · Mar 3, 2024 · f3b27d0 · f3b27d0
1 parent 555e0cc
commit f3b27d0
Showing 1 changed file with 2 additions and 4 deletions.
diff --git a/src/main/java/org/carlmontrobotics/subsystems/Arm.java b/src/main/java/org/carlmontrobotics/subsystems/Arm.java
@@ -182,10 +182,8 @@ public void setArmTarget(double targetPos) {
 
 
     public void resetGoal() {
-
-        armProfile = new TrapezoidProfile(TRAP_CONSTRAINTS);
-
-
+        double armPos = getArmPos();
+        setArmTarget(armPos);
     }
     public void driveMotor(Measure<Voltage> volts) {
        armMotorMaster.setVoltage(volts.in(Volts));