Set motor init values

publish.gradle

@@ -2,7 +2,7 @@ apply plugin: 'maven-publish'
 
 ext.licenseFile = files("$rootDir/LICENSE.txt")
 
-def pubVersion = '2025.21.0204'
+def pubVersion = '2025.0.0065'
 
 def outputsFolder = file("$buildDir/outputs")
 

src/main/java/tagalong/commands/base/ElevateToCmd.java

@@ -90,7 +90,7 @@ public void end(boolean interrupted) {
   public boolean isFinished() {
     // Command is finished when the profile is finished AND
     // Either the tolerance is bypassed or in tolerance for the desired duration
-    return _elevator.isProfileFinished()
+    return _startedMovement && _elevator.isProfileFinished()
         && (!_requireInTolerance
             || _elevator.checkToleranceTime(
                 _elevator.isElevatorInTolerance(_lowerBoundM, _upperBoundM),

src/main/java/tagalong/commands/base/ElevateXCmd.java

@@ -104,7 +104,7 @@ public void end(boolean interrupted) {
   public boolean isFinished() {
     // Command is finished when the profile is finished AND
     // Either the tolerance is bypassed or in tolerance for the desired duration
-    return _elevator.isProfileFinished()
+    return _startedMovement && _elevator.isProfileFinished()
         && (!_requireInTolerance
             || _elevator.checkToleranceTime(
                 _elevator.isElevatorInTolerance(_lowerBoundM, _upperBoundM),

src/main/java/tagalong/commands/base/PivotToAbsoluteCmd.java

@@ -80,10 +80,7 @@ public void execute() {
       if (_scopedGoalPositionRot > _pivot._maxPositionRot) {
         _scopedGoalPositionRot -= 1.0;
       }
-
-      _pivot.setPivotProfile(
-          _pivot.clampPivotPosition(_scopedGoalPositionRot), 0.0, _maxVelocityRPS
-      );
+      _pivot.setPivotProfile(_scopedGoalPositionRot, 0.0, _maxVelocityRPS);
     }
 
     if (_startedMovement) {