@@ -165,7 +165,6 @@ public void pidSet(UnifiedControlMode controlMode, double leftSetpoint, double r
165
165
case CURRENT -> new TorqueCurrentFOC (leftSetpoint );
166
166
case PERCENT_OUTPUT -> new DutyCycleOut (leftSetpoint );
167
167
case TRAPEZOID_PROFILE -> new MotionMagicDutyCycle (leftSetpoint );
168
- case MOTION_PROFILING -> throw new UnsupportedOperationException ("Motion Profiling is not yet implemented in SpikesLib2!" );
169
168
case VOLTAGE -> new VoltageOut (leftSetpoint );
170
169
case VELOCITY -> new VelocityDutyCycle (leftSetpoint );
171
170
case POSITION -> new PositionDutyCycle (leftSetpoint );
@@ -174,7 +173,6 @@ public void pidSet(UnifiedControlMode controlMode, double leftSetpoint, double r
174
173
case CURRENT -> new TorqueCurrentFOC (rightSetpoint );
175
174
case PERCENT_OUTPUT -> new DutyCycleOut (rightSetpoint );
176
175
case TRAPEZOID_PROFILE -> new MotionMagicDutyCycle (rightSetpoint );
177
- case MOTION_PROFILING -> throw new UnsupportedOperationException ("Motion Profiling is not yet implemented in SpikesLib2!" );
178
176
case VOLTAGE -> new VoltageOut (rightSetpoint );
179
177
case VELOCITY -> new VelocityDutyCycle (rightSetpoint );
180
178
case POSITION -> new PositionDutyCycle (rightSetpoint );
@@ -206,7 +204,7 @@ public void finish() {
206
204
public boolean leftOnTarget (UnifiedControlMode controlMode , double tolerance , double setpoint ) {
207
205
double value = switch (controlMode ) {
208
206
case VELOCITY -> leftMaster .getVelocity ().getValueAsDouble ();
209
- case POSITION , MOTION_PROFILING , TRAPEZOID_PROFILE -> leftMaster .getPosition ().getValueAsDouble ();
207
+ case POSITION , TRAPEZOID_PROFILE -> leftMaster .getPosition ().getValueAsDouble ();
210
208
case CURRENT -> leftMaster .getTorqueCurrent ().getValueAsDouble ();
211
209
case PERCENT_OUTPUT -> leftMaster .get ();
212
210
case VOLTAGE -> leftMaster .getMotorVoltage ().getValueAsDouble ();
@@ -226,7 +224,7 @@ public boolean leftOnTarget(UnifiedControlMode controlMode, double tolerance, do
226
224
public boolean rightOnTarget (UnifiedControlMode controlMode , double tolerance , double setpoint ) {
227
225
double value = switch (controlMode ) {
228
226
case VELOCITY -> rightMaster .getVelocity ().getValueAsDouble ();
229
- case POSITION , MOTION_PROFILING , TRAPEZOID_PROFILE -> rightMaster .getPosition ().getValueAsDouble ();
227
+ case POSITION , TRAPEZOID_PROFILE -> rightMaster .getPosition ().getValueAsDouble ();
230
228
case CURRENT -> rightMaster .getTorqueCurrent ().getValueAsDouble ();
231
229
case PERCENT_OUTPUT -> rightMaster .get ();
232
230
case VOLTAGE -> rightMaster .getMotorVoltage ().getValueAsDouble ();
0 commit comments