Get drive working

Still needs more work

build.gradle

@@ -161,9 +161,6 @@ tasks.register('eventDeploy') {
             commandLine 'git', 'commit', '-m', commitMessage
         }
 
-        //'git add -A'.execute()
-        // commandLine 'git', 'add', '-A'
-
         println "Deployed to branch: '$branch'"
         println "Commit message: '$commitMessage'"
     }

src/main/java/frc/robot/Constants.java

@@ -27,7 +27,7 @@
  */
 public final class Constants {
   public static final int loopPeriodMs = 20;
-  private static RobotType robotType = RobotType.SIMBOT;
+  private static RobotType robotType = RobotType.RAINBOWT;
   public static final boolean tuningMode = true;
   public static final boolean characterizationMode = false;
 

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

@@ -20,11 +20,10 @@
 import edu.wpi.first.wpilibj.simulation.DriverStationSim;
 import edu.wpi.first.wpilibj2.command.Command;
 import edu.wpi.first.wpilibj2.command.CommandScheduler;
+import frc.robot.util.VirtualSubsystem;
 import java.util.HashMap;
 import java.util.Map;
 import java.util.function.BiConsumer;
-
-import frc.robot.util.VirtualSubsystem;
 import org.littletonrobotics.junction.LogFileUtil;
 import org.littletonrobotics.junction.LoggedRobot;
 import org.littletonrobotics.junction.Logger;
@@ -147,10 +146,10 @@ public void robotPeriodic() {
       if (!autoCommand.isScheduled() && !autoMessagePrinted) {
         if (DriverStation.isAutonomousEnabled()) {
           System.out.printf(
-                  "*** Auto finished in %.2f secs ***%n", Timer.getFPGATimestamp() - autoStart);
+              "*** Auto finished in %.2f secs ***%n", Timer.getFPGATimestamp() - autoStart);
         } else {
           System.out.printf(
-                  "*** Auto cancelled in %.2f secs ***%n", Timer.getFPGATimestamp() - autoStart);
+              "*** Auto cancelled in %.2f secs ***%n", Timer.getFPGATimestamp() - autoStart);
         }
         autoMessagePrinted = true;
       }