Add pseudo code

src/main/java/frc/robot/Robot.java

@@ -22,6 +22,8 @@
 import frc.robot.auton.SequentialActionRunner;
 import frc.robot.motor.MotorController;
 import frc.robot.motor.MotorControllerFactory;
+import frc.robot.pseudoCode.CodeRunner;
+import frc.robot.pseudoCode.PseudoCodeActions;
 import java.text.DecimalFormat;
 import java.util.ArrayDeque;
 
@@ -261,6 +263,7 @@ public void setupAutonRoutes() {
         );
         autonRouteChooser.addOption("Test Manual PID movement", AutonRoutes.TEST_PID_MOVEMENT);
         autonRouteChooser.addOption("Test Manual Backward PID movement", AutonRoutes.TEST_PID_BACKWARD_MOVEMENT);
+        autonRouteChooser.addOption("Run Pseudo Code", PseudoCodeActions.pseudoCodeActionQueue);
     }
 
     /*
@@ -316,6 +319,7 @@ public void robotPeriodic() {
      */
     @Override
     public void autonomousInit() {
+        CodeRunner.main(new String[] { "this argument is useless" });
         AutonRoutes.setupCorrectAutonPaths();
         ArrayDeque<AutonAction> route = new ArrayDeque<>(autonRouteChooser.getSelected());
         double delayAmount = SmartDashboard.getNumber("Auton Delay (sec)", 0.0);

src/main/java/frc/robot/pseudoCode/CodeRunner.java

@@ -0,0 +1,8 @@
+package frc.robot.pseudoCode;
+
+import static frc.robot.pseudoCode.PseudoCodeActions.*;
+
+public class CodeRunner {
+
+    public static void main(String[] args) {}
+}

src/main/java/frc/robot/pseudoCode/PseudoCodeActions.java

@@ -0,0 +1,51 @@
+package frc.robot.pseudoCode;
+
+import frc.robot.auton.AutonAction;
+import frc.robot.auton.AutonMoveInches;
+import frc.robot.auton.AutonRotateWithPIDCommand;
+import frc.robot.auton.AutonShoot;
+import frc.robot.auton.AutonShooterFeed;
+import frc.robot.auton.ExtendArms;
+import frc.robot.auton.RetractArms;
+import java.util.ArrayDeque;
+
+public class PseudoCodeActions {
+
+    public static ArrayDeque<AutonAction> pseudoCodeActionQueue = new ArrayDeque<>();
+
+    public static void addAction(AutonAction action) {
+        pseudoCodeActionQueue.add(action);
+    }
+
+    public static void moveForwards(int inches) {
+        addAction(new AutonMoveInches(inches));
+    }
+
+    public static void moveBackwards(int inches) {
+        addAction(new AutonMoveInches(-inches));
+    }
+
+    public static void rotateRight(double degrees) {
+        addAction(new AutonRotateWithPIDCommand(degrees));
+    }
+
+    public static void rotateLeft(double degrees) {
+        addAction(new AutonRotateWithPIDCommand(-degrees));
+    }
+
+    public static void shoot() {
+        addAction(new AutonShoot());
+    }
+
+    public static void feed() {
+        addAction(new AutonShooterFeed());
+    }
+
+    public static void raiseArms() {
+        addAction(new ExtendArms());
+    }
+
+    public static void lowerArms() {
+        addAction(new RetractArms());
+    }
+}