small comment clean up

team1868 · Feb 4, 2025 · 3c32204 · 3c32204
1 parent f3319a5
commit 3c32204
Show file tree

Hide file tree

Showing 3 changed files with 8 additions and 30 deletions.
diff --git a/src/main/java/tagalong/subsystems/micro/PivotFused.java b/src/main/java/tagalong/subsystems/micro/PivotFused.java
@@ -55,11 +55,8 @@ public void followLastProfile() {
 
     TrapezoidProfile.State nextState =
         _trapProfile.calculate(TagalongConfiguration.LOOP_PERIOD_S, _curState, _goalState);
-    // FUTURE DEV: modify to allow for unfused or not 1:1 with pivot, convert to motor units
     _primaryMotor.setControl(
-        _requestedPositionVoltage
-            .withPosition(nextState.position)
-            // FeedForward must know the pivot rotation and other arguments in radians
+        _requestedPositionVoltage.withPosition(nextState.position)
             .withFeedForward(
                 _pivotFF.calculate(getFFPositionRad(), Units.rotationsToRadians(nextState.velocity))
             )
@@ -79,7 +76,6 @@ public double getFFPositionRad() {
       return 0.0;
     }
 
-    // FUTURE DEV: modify to allow for unfused or not 1:1 with pivot
     return Units.rotationsToRadians(_pivotCancoder.getPosition().getValueAsDouble())
         + _ffCenterOfMassOffsetRad;
   }
@@ -91,14 +87,9 @@ public void setPivotVelocity(double rps, boolean withFF) {
     }
     setFollowProfile(false);
 
-    _primaryMotor.setControl(
-        _requestedVelocityVoltage
-            // FUTURE DEV: modify to allow for unfused or not 1:1 with pivot
-            .withVelocity(rps)
-            .withFeedForward(
-                withFF ? _pivotFF.calculate(getFFPositionRad(), Units.rotationsToRadians(rps)) : 0.0
-            )
-    );
+    _primaryMotor.setControl(_requestedVelocityVoltage.withVelocity(rps).withFeedForward(
+        withFF ? _pivotFF.calculate(getFFPositionRad(), Units.rotationsToRadians(rps)) : 0.0
+    ));
   }
 
   @Override
@@ -173,7 +164,6 @@ public void simulationPeriodic() {
     _pivotSim.setInputVoltage(_primaryMotor.get() * RobotController.getBatteryVoltage());
     _pivotSim.update(TagalongConfiguration.LOOP_PERIOD_S);
 
-    // FUTURE DEV: modify to allow for unfused or not 1:1 with pivot
     double prevSimVelo = _simVeloRPS;
     _simVeloRPS = Units.radiansToRotations(_pivotSim.getVelocityRadPerSec());
     _simRotations += Units.radiansToRotations(_pivotSim.getAngleRads());

diff --git a/src/main/java/tagalong/subsystems/micro/PivotNoCancoder.java b/src/main/java/tagalong/subsystems/micro/PivotNoCancoder.java
@@ -40,11 +40,8 @@ public void followLastProfile() {
 
     TrapezoidProfile.State nextState =
         _trapProfile.calculate(TagalongConfiguration.LOOP_PERIOD_S, _curState, _goalState);
-    // FUTURE DEV: modify to allow for unfused or not 1:1 with pivot, convert to motor units
     _primaryMotor.setControl(
-        _requestedPositionVoltage
-            .withPosition(pivotRotToMotor(nextState.position))
-            // FeedForward must know the pivot rotation and other arguments in radians
+        _requestedPositionVoltage.withPosition(pivotRotToMotor(nextState.position))
             .withFeedForward(
                 _pivotFF.calculate(getFFPositionRad(), Units.rotationsToRadians(nextState.velocity))
             )
@@ -64,7 +61,6 @@ public double getFFPositionRad() {
       return 0.0;
     }
 
-    // FUTURE DEV: modify to allow for unfused or not 1:1 with pivot
     return Units.rotationsToRadians(getPivotPosition()) + _ffCenterOfMassOffsetRad;
   }
 
@@ -76,9 +72,7 @@ public void setPivotVelocity(double rps, boolean withFF) {
     setFollowProfile(false);
 
     _primaryMotor.setControl(
-        _requestedVelocityVoltage
-            // FUTURE DEV: modify to allow for unfused or not 1:1 with pivot
-            .withVelocity(pivotRotToMotor(rps))
+        _requestedVelocityVoltage.withVelocity(pivotRotToMotor(rps))
             .withFeedForward(
                 withFF ? _pivotFF.calculate(getFFPositionRad(), Units.rotationsToRadians(rps)) : 0.0
             )
@@ -127,7 +121,6 @@ public void simulationPeriodic() {
     _pivotSim.setInputVoltage(_primaryMotor.get() * RobotController.getBatteryVoltage());
     _pivotSim.update(TagalongConfiguration.LOOP_PERIOD_S);
 
-    // FUTURE DEV: modify to allow for unfused or not 1:1 with pivot
     double prevSimVelo = _simVeloRPS;
     _simVeloRPS = Units.radiansToRotations(_pivotSim.getVelocityRadPerSec());
     _simRotations += Units.radiansToRotations(_pivotSim.getAngleRads());

diff --git a/src/main/java/tagalong/subsystems/micro/PivotUnfused.java b/src/main/java/tagalong/subsystems/micro/PivotUnfused.java
@@ -60,11 +60,8 @@ public void followLastProfile() {
 
     TrapezoidProfile.State nextState =
         _trapProfile.calculate(TagalongConfiguration.LOOP_PERIOD_S, _curState, _goalState);
-    // FUTURE DEV: modify to allow for unfused or not 1:1 with pivot, convert to motor units
     _primaryMotor.setControl(
-        _requestedPositionVoltage
-            .withPosition(pivotRotToMotor(nextState.position))
-            // FeedForward must know the pivot rotation and other arguments in radians
+        _requestedPositionVoltage.withPosition(pivotRotToMotor(nextState.position))
             .withFeedForward(
                 _pivotFF.calculate(getFFPositionRad(), Units.rotationsToRadians(nextState.velocity))
             )
@@ -97,9 +94,7 @@ public void setPivotVelocity(double rps, boolean withFF) {
     setFollowProfile(false);
 
     _primaryMotor.setControl(
-        _requestedVelocityVoltage
-            // FUTURE DEV: modify to allow for unfused or not 1:1 with pivot
-            .withVelocity(pivotRotToMotor(rps))
+        _requestedVelocityVoltage.withVelocity(pivotRotToMotor(rps))
             .withFeedForward(
                 withFF ? _pivotFF.calculate(getFFPositionRad(), Units.rotationsToRadians(rps)) : 0.0
             )