fixed rawforward so the wheels align

DeepBlueRobotics · Sep 27, 2024 · d1ea79e · d1ea79e
1 parent cd9bb2c
commit d1ea79e
Showing 1 changed file with 3 additions and 1 deletion.
diff --git a/src/main/java/org/carlmontrobotics/RobotContainer.java b/src/main/java/org/carlmontrobotics/RobotContainer.java
@@ -431,7 +431,9 @@ private void setupAutos() {
             // NOTHING
             autoCommands.add(0, new PrintCommand("Running NULL Auto!"));
             // RAW FORWARD command
-            autoCommands.add(1, new LastResortAuto(drivetrain));
+            autoCommands.add(1, new SequentialCommandGroup(
+                            new InstantCommand(() -> drivetrain.drive(-.0001, 0, 0)), new WaitCommand(0.5),
+                            new LastResortAuto(drivetrain)));
             // dumb PP forward command
             autoCommands.add(2, new PrintCommand("PPSimpleAuto not Configured!"));
         }