X-Git-Url: http://challenge-bot.com/repos/?a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2FRobot.java;h=e3b51888b5f6a2d65cfb531616bd73db08f33f9d;hb=c859a8e2f7dcd8ce870586ec5a87f459b97a362c;hp=2b58d19d22d5f41dfce87d95c7ab1dd98b0fc04c;hpb=1b977a14046555f6ae3bb3d09cedf543e049ddc7;p=3501%2Fstronghold-2016

diff --git a/src/org/usfirst/frc/team3501/robot/Robot.java b/src/org/usfirst/frc/team3501/robot/Robot.java
index 2b58d19d..e3b51888 100644
--- a/src/org/usfirst/frc/team3501/robot/Robot.java
+++ b/src/org/usfirst/frc/team3501/robot/Robot.java
@@ -10,7 +10,6 @@ import edu.wpi.first.wpilibj.CameraServer;
 import edu.wpi.first.wpilibj.IterativeRobot;
 import edu.wpi.first.wpilibj.command.Scheduler;
 import edu.wpi.first.wpilibj.smartdashboard.SendableChooser;
-import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
 
 public class Robot extends IterativeRobot {
   public static OI oi;
@@ -30,38 +29,21 @@ public class Robot extends IterativeRobot {
 
     oi = new OI();
 
-    initializeSendableChooser();
-    addFrontChooserOptions();
-    sendSendableChooserToSmartDashboard();
-
     camera = CameraServer.getInstance();
-    camera.setQuality(50);
+    camera.setQuality(25);
     camera.startAutomaticCapture("cam0");
   }
 
-  private void initializeSendableChooser() {
-    frontChooser = new SendableChooser();
-  }
-
-  private void addFrontChooserOptions() {
-    frontChooser.addDefault("Intake", false);
-    frontChooser.addObject("Shooter", true);
-  }
-
-  private void sendSendableChooserToSmartDashboard() {
-    SmartDashboard.putData("PositionChooser", frontChooser);
-  }
-
   @Override
   public void autonomousInit() {
-    // get options chosen from drop down menu
-    boolean flip = (boolean) frontChooser.getSelected();
-
-    if (flip) {
-      driveTrain.toggleFlipped();
-    }
-
-    Scheduler.getInstance().add(new TimeDrive(4, .7));
+    //
+    // Scheduler.getInstance().add(new
+    // MoveIntakeArm(Constants.IntakeArm.RETRACT));
+    // Scheduler.getInstance().add(new TimeDrive(1, .6));
+    // Scheduler.getInstance().add(new WaitCommand(1));
+    // Scheduler.getInstance().add(new
+    // MoveIntakeArm(Constants.IntakeArm.EXTEND));
+    Scheduler.getInstance().add(new TimeDrive(8, -.8));
   }
 
   @Override