Update ports to competition setup, minor bugfixes
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / Robot.java
index 7678a7289cc4506c66670c42418b5292fa9a0ef5..8616cfa765dd39fe98e3f3eeb42c6f3534c45b13 100644 (file)
@@ -1,6 +1,6 @@
 package org.usfirst.frc.team3501.robot;
 
-import org.usfirst.frc.team3501.robot.commands.driving.SetLowGear;
+import org.usfirst.frc.team3501.robot.commands.driving.SetHighGear;
 import org.usfirst.frc.team3501.robot.commands.intakearm.MoveIntakeArm;
 import org.usfirst.frc.team3501.robot.commands.shooter.ResetCatapult;
 import org.usfirst.frc.team3501.robot.subsystems.DriveTrain;
@@ -27,7 +27,6 @@ public class Robot extends IterativeRobot {
 
   @Override
   public void autonomousInit() {
-    Scheduler.getInstance().run();
   }
 
   @Override
@@ -37,13 +36,9 @@ public class Robot extends IterativeRobot {
 
   @Override
   public void teleopInit() {
-    Scheduler.getInstance().add(new SetLowGear()); // Start each match in low
-                                                   // gear
-    Scheduler.getInstance().add(new ResetCatapult()); // Reset catapult at start
-                                                      // of each match.
-
+    Scheduler.getInstance().add(new SetHighGear());
+    Scheduler.getInstance().add(new ResetCatapult());
     Scheduler.getInstance().add(new MoveIntakeArm(Constants.IntakeArm.EXTEND));
-    // Start testing with intake arm extended TODO remove this
   }
 
   @Override