From 99113013f9dfa107b67cb99ff00547c370a929c8 Mon Sep 17 00:00:00 2001 From: Ivan Chen Date: Fri, 15 Mar 2024 17:43:45 -0500 Subject: [PATCH] actual auto --- .../frc/robot/commands/auto/SimpleAutoPlanLeft.java | 10 ++++++---- 1 file changed, 6 insertions(+), 4 deletions(-) diff --git a/src/main/java/frc/robot/commands/auto/SimpleAutoPlanLeft.java b/src/main/java/frc/robot/commands/auto/SimpleAutoPlanLeft.java index 365c025..1f9ac19 100644 --- 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);