Add reverse mode

Add reverse mode
Add example auto sequential commands

TODO:
Run with the robot
Do math
This commit is contained in:
Astatin3
2024-02-16 17:04:46 -07:00
parent 4b7cb07c1b
commit 84c5313a50
5 changed files with 60 additions and 22 deletions
+2 -1
View File
@@ -143,7 +143,8 @@ public final class Constants {
public static final Translation2d RedSpeakerCenter = new Translation2d(7.914259, -3.221609);
public static final Translation2d BlueSpeakerCenter = new Translation2d(-8.308975, 1.442593);
public static final double SpeakerBubbleDistance = 1.5;
public static final double SpeakerBubbleDistance = 3;
public static final double targetPosDistance = 1.5;
}