Skip to content

Commit

Permalink
chore: remove commented code
Browse files Browse the repository at this point in the history
  • Loading branch information
mimizh2418 committed Apr 16, 2024
1 parent d65955c commit 14fb2d7
Show file tree
Hide file tree
Showing 4 changed files with 1 addition and 19 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -6,14 +6,11 @@
import org.team1540.robot2024.Constants;
import org.team1540.robot2024.commands.elevator.ElevatorSetpointCommand;
import org.team1540.robot2024.commands.indexer.StageTrampCommand;
import org.team1540.robot2024.commands.shooter.PrepareShooterCommand;
import org.team1540.robot2024.subsystems.drive.Drivetrain;
import org.team1540.robot2024.subsystems.elevator.Elevator;
import org.team1540.robot2024.subsystems.indexer.Indexer;
import org.team1540.robot2024.subsystems.shooter.Shooter;
import org.team1540.robot2024.subsystems.tramp.Tramp;
import org.team1540.robot2024.util.auto.PathHelper;
import org.team1540.robot2024.util.shooter.ShooterSetpoint;
import org.team1540.robot2024.util.vision.AprilTagsCrescendo;

import java.util.function.Supplier;
Expand All @@ -35,12 +32,7 @@ public ClimbAlignment(Drivetrain drivetrain, Elevator elevator, Tramp tramp, Ind
),
new ProxyCommand(() -> climbPath(drivetrain::getPose, 1))
),
// Commands.runOnce(() -> drivetrain.setBrakeMode(false))
// Commands.waitSeconds(5), //Confirm that nothing will break
Commands.runOnce(()->elevator.setFlipper(true)),
// new ElevatorSetpointCommand(elevator, Constants.Elevator.ElevatorState.TOP),
// Commands.runOnce(() -> drivetrain.setBrakeMode(true)),
// Commands.waitSeconds(5), //Confirm that nothing will break
new ProxyCommand(() -> climbPath(drivetrain::getPose, 2)),
new ElevatorSetpointCommand(elevator, Constants.Elevator.ElevatorState.AMP),
Commands.parallel(
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -14,7 +14,6 @@ public PrepareFeederForShooter(Indexer indexer) {

@Override
public void initialize() {
// indexer.setFeederVelocity(1200); TODO Make this work again
indexer.setFeederPercent(0.5);
}

Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -16,7 +16,7 @@ public StageTrampCommand(Tramp tramp, Indexer indexer) {
}
@Override
public void initialize() {
tramp.setPercent(1); //TODO: Tune this
tramp.setPercent(1);
indexer.setFeederPercent(-1);
indexer.setIntakePercent(1);
}
Expand All @@ -32,6 +32,4 @@ public void end(boolean interrupted) {
indexer.stopIntake();
tramp.stop();
}


}
Original file line number Diff line number Diff line change
Expand Up @@ -2,9 +2,6 @@

import edu.wpi.first.math.geometry.Pose2d;
import edu.wpi.first.math.geometry.Rotation2d;
import edu.wpi.first.wpilibj2.command.Command;
import edu.wpi.first.wpilibj2.command.Commands;
import edu.wpi.first.wpilibj2.command.ProxyCommand;
import edu.wpi.first.wpilibj2.command.SequentialCommandGroup;
import org.team1540.robot2024.Constants;
import org.team1540.robot2024.subsystems.drive.Drivetrain;
Expand Down Expand Up @@ -36,10 +33,6 @@ public AutoShootPrepare(Supplier<Pose2d> positionSupplier, Shooter shooter, doub
)
// shooter.lerp.get(positionSupplier.get().getTranslation().getDistance(AprilTagsCrescendo.getInstance().getTag(AprilTagsCrescendo.Tags.SPEAKER_CENTER).toPose2d().getTranslation()))
)
// .alongWith(
// new ProxyCommand(Commands.runOnce(()->positionSupplier.get().getTranslation().getDistance(AprilTagsCrescendo.getInstance().getTag(AprilTagsCrescendo.Tags.SPEAKER_CENTER).toPose2d().getTranslation())))
// Commands.deferredProxy(Commands.runOnce(()->positionSupplier.get().getTranslation().getDistance(AprilTagsCrescendo.getInstance().getTag(AprilTagsCrescendo.Tags.SPEAKER_CENTER).toPose2d().getTranslation())))
// )
);
}

Expand Down

0 comments on commit 14fb2d7

Please sign in to comment.