55
66import com .ctre .phoenix6 .SignalLogger ;
77import com .ctre .phoenix6 .signals .InvertedValue ;
8-
9- import choreo .util .ChoreoAllianceFlipUtil ;
108import edu .wpi .first .math .geometry .Pose2d ;
119import edu .wpi .first .math .geometry .Rotation2d ;
1210import edu .wpi .first .net .WebServer ;
1513import edu .wpi .first .wpilibj .Alert .AlertType ;
1614import edu .wpi .first .wpilibj .DataLogManager ;
1715import edu .wpi .first .wpilibj .DriverStation ;
18- import edu .wpi .first .wpilibj .DriverStation .Alliance ;
1916import edu .wpi .first .wpilibj .Filesystem ;
2017import edu .wpi .first .wpilibj .Threads ;
2118import edu .wpi .first .wpilibj2 .command .Command ;
2219import edu .wpi .first .wpilibj2 .command .CommandScheduler ;
23- import edu .wpi .first .wpilibj2 .command .Commands ;
2420import edu .wpi .first .wpilibj2 .command .Subsystem ;
2521import edu .wpi .first .wpilibj2 .command .button .CommandXboxController ;
2622import edu .wpi .first .wpilibj2 .command .button .Trigger ;
5753import org .curtinfrc .frc2026 .subsystems .hoodedshooter .ShooterIOComp ;
5854import org .curtinfrc .frc2026 .subsystems .hoodedshooter .ShooterIODev ;
5955import org .curtinfrc .frc2026 .subsystems .hoodedshooter .ShooterIOSim ;
60- import org .curtinfrc .frc2026 .util .FieldConstants ;
6156import org .curtinfrc .frc2026 .util .GameState ;
6257import org .curtinfrc .frc2026 .util .PhoenixUtil ;
6358import org .curtinfrc .frc2026 .util .Repulsor .Behaviours .AutoPathBehaviour ;
6661import org .curtinfrc .frc2026 .util .Repulsor .Behaviours .ShuttleRecoveryBehaviour ;
6762import org .curtinfrc .frc2026 .util .Repulsor .Behaviours .TestBehaviour ;
6863import org .curtinfrc .frc2026 .util .Repulsor .Commands .Triggers ;
69- import org .curtinfrc .frc2026 .util .Repulsor .DriverStation .NtRepulsorDriverStation ;
7064import org .curtinfrc .frc2026 .util .Repulsor .DriverStation .RepulsorDriverStation ;
7165import org .curtinfrc .frc2026 .util .Repulsor .DriverStation .RepulsorDriverStationBootstrap ;
7266import org .curtinfrc .frc2026 .util .Repulsor .Fallback ;
@@ -391,10 +385,13 @@ public Robot() {
391385 // }
392386
393387 // } else {
394- // // If alliance is blue, then check if it is in the alliance zone by checking the x
395- // // value is less than the left trench opening (opponent) Then set the location to
388+ // // If alliance is blue, then check if it is in the alliance zone by checking
389+ // the x
390+ // // value is less than the left trench opening (opponent) Then set the location
391+ // to
396392 // // hub.
397- // if (currentPosition.getX() < FieldConstants.LeftTrench.oppOpeningTopLeft.getX()) {
393+ // if (currentPosition.getX() <
394+ // FieldConstants.LeftTrench.oppOpeningTopLeft.getX()) {
398395 // drive.locationHeadingjoyStickDrive(
399396 // () -> -controller.getLeftY(),
400397 // () -> -controller.getLeftX(),
@@ -421,9 +418,11 @@ public Robot() {
421418 // });
422419 // Pose2d currentPosition = drive.getPose();
423420 // Trigger isRed =
424- // new Trigger(() -> DriverStation.getAlliance().orElse(Alliance.Blue).equals(Alliance.Red));
421+ // new Trigger(() ->
422+ // DriverStation.getAlliance().orElse(Alliance.Blue).equals(Alliance.Red));
425423 // Trigger isBlue =
426- // new Trigger(() -> DriverStation.getAlliance().orElse(Alliance.Red).equals(Alliance.Blue));
424+ // new Trigger(() ->
425+ // DriverStation.getAlliance().orElse(Alliance.Red).equals(Alliance.Blue));
427426
428427 // Trigger isLeft =
429428 // new Trigger(() -> currentPosition.getY() < FieldConstants.Hub.topCenterPoint.getY());
@@ -556,11 +555,13 @@ public Robot() {
556555
557556 wireRepulsor ();
558557
559- // controller.a().whileTrue(drive.alignTo(new Pose2d(Constants.FIELD_LENGTH / 2, Constants.FIELD_WIDTH / 2, new Rotation2d())));
558+ // controller.a().whileTrue(drive.alignTo(new Pose2d(Constants.FIELD_LENGTH / 2,
559+ // Constants.FIELD_WIDTH / 2, new Rotation2d())));
560560 // controller.b().whileTrue(
561561 // drive.alignTo(
562562 // ChoreoAllianceFlipUtil.flip(new Pose2d(
563- // 15.391 - (Constants.ROBOT_X / 2), 3.84 + (Constants.ROBOT_Y / 2), new Rotation2d()))));
563+ // 15.391 - (Constants.ROBOT_X / 2), 3.84 + (Constants.ROBOT_Y / 2), new
564+ // Rotation2d()))));
564565
565566 System .out .println ("Robot initialized." );
566567 }
0 commit comments