actual auto

titan2022 · Mar 15, 2024 · 9911301 · 9911301
1 parent 42f515a
commit 9911301
Showing 1 changed file with 6 additions and 4 deletions.
diff --git a/src/main/java/frc/robot/commands/auto/SimpleAutoPlanLeft.java b/src/main/java/frc/robot/commands/auto/SimpleAutoPlanLeft.java
@@ -5,6 +5,7 @@
 import edu.wpi.first.math.geometry.Rotation2d;
 import edu.wpi.first.math.geometry.Translation2d;
 import edu.wpi.first.util.datalog.DataLog;
+import edu.wpi.first.wpilibj.DriverStation.Alliance;
 import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
 import edu.wpi.first.wpilibj2.command.SequentialCommandGroup;
 import edu.wpi.first.wpilibj2.command.WaitCommand;
@@ -18,6 +19,7 @@
 import frc.robot.subsystems.ShooterSubsystem;
 import frc.robot.subsystems.drive.RotationalDrivebase;
 import frc.robot.subsystems.drive.TranslationalDrivebase;
+import frc.robot.utility.Constants;
 import frc.robot.utility.Localizer;
 
 /** An example command that uses an example subsystem. */
@@ -30,10 +32,10 @@ public class SimpleAutoPlanLeft extends SequentialCommandGroup {
 
     public SimpleAutoPlanLeft(TranslationalDrivebase translational, RotationalDrivebase rotational, ShooterSubsystem shooter, IndexerSubsystem indexer, IntakeSubsystem intake, ElevatorSubsystem elevator, Localizer localizer) {
         double sign = 1;
-        // if (Constants.getColor() == Alliance.Blue) {    
-        //     sign = 1;
-        // } else 
-        //     sign = -1;
+        if (Constants.getColor() == Alliance.Blue) {    
+            sign = 1;
+        } else 
+            sign = -1;
 
         SmartDashboard.putBoolean("1", true);