Add button to switch between arcade drive and tank drive

Robot2019/src/main/java/frc/robot/OI.java

@@ -16,6 +16,7 @@
 import frc.robot.commands.Climb;
 import frc.robot.commands.EjectCargo;
 import frc.robot.commands.IntakeOnlyCargo;
+import frc.robot.commands.SetArcadeOrTank;
 import frc.robot.commands.SlowDrive;
 import frc.robot.commands.ToggleCamera;
 import frc.robot.commands.ToggleHatch;
@@ -32,6 +33,7 @@ public class OI {
   Joystick leftJoy, rightJoy, manipulator;
 
   JoystickButton leftSlowBtn, rightSlowBtn;
+  JoystickButton arcadeOrTankBtn;
   JoystickButton normDriveBtn;
   JoystickButton toggleHatchBtn;
   JoystickButton cargoIntakeBtn, cargoEjectBtn;
@@ -50,6 +52,8 @@ public class OI {
     rightSlowBtn = new JoystickButton(rightJoy, 1);
     rightSlowBtn.whileHeld(new SlowDrive(SlowDrive.Side.RIGHT));
 
+    arcadeOrTankBtn = new JoystickButton(leftJoy, 4);
+    arcadeOrTankBtn.whenPressed(new SetArcadeOrTank());
     normDriveBtn = new JoystickButton(leftJoy, 3);
     normDriveBtn.whileHeld(new NormalDrive());
 

Robot2019/src/main/java/frc/robot/commands/SetArcadeOrTank.java

@@ -0,0 +1,19 @@
+package frc.robot.commands;
+
+import edu.wpi.first.wpilibj.command.InstantCommand;
+import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
+
+public class SetArcadeOrTank extends InstantCommand {
+    public SetArcadeOrTank() {
+
+    }
+
+    protected void initialize() {
+        if (SmartDashboard.getBoolean("Arcade Drive", true)) {
+            SmartDashboard.putBoolean("Arcade Drive", false);
+        } else {
+            SmartDashboard.putBoolean("Arcade Drive", true);
+        }
+
+    }
+}