Add testing stuff

[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / Robot.java

diff --git a/src/org/usfirst/frc/team3501/robot/Robot.java b/src/org/usfirst/frc/team3501/robot/Robot.java
index 19fa056a857c635282ca337eed87d1db08ca4a96..1f86b9bcf71889f6d610a76a737a211a0ce58ea5 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/Robot.java
+++ b/src/org/usfirst/frc/team3501/robot/Robot.java
@@ -8,6 +8,7 @@ import org.usfirst.frc.team3501.robot.subsystems.IntakeArm;
 import org.usfirst.frc.team3501.robot.subsystems.Scaler;
 import org.usfirst.frc.team3501.robot.subsystems.Shooter;
 
+import edu.wpi.first.wpilibj.Compressor;
 import edu.wpi.first.wpilibj.IterativeRobot;
 import edu.wpi.first.wpilibj.command.Scheduler;
 import edu.wpi.first.wpilibj.smartdashboard.SendableChooser;
@@ -23,10 +24,12 @@ public class Robot extends IterativeRobot {
   public static IntakeArm intakeArm;
   public static DefenseArm defenseArm;
 
+  public static Compressor compressor;
+
   // Sendable Choosers send a drop down menu to the Smart Dashboard.
   SendableChooser positionChooser;
   SendableChooser positionOneDefense, positionTwoDefense, positionThreeDefense,
-  positionFourDefense, positionFiveDefense;
+      positionFourDefense, positionFiveDefense;
 
   @Override
   public void robotInit() {
@@ -41,6 +44,7 @@ public class Robot extends IterativeRobot {
     // addPositionChooserOptions();
     // addDefensesToAllDefenseSendableChoosers();
     // sendSendableChoosersToSmartDashboard();
+    compressor = new Compressor();
 
   }
 
@@ -121,8 +125,11 @@ public class Robot extends IterativeRobot {
 
   @Override
   public void teleopInit() {
-    Scheduler.getInstance().add(new JoystickDrive());
 
+    Scheduler.getInstance().add(new JoystickDrive());
+    compressor.start();
+    driveTrain.leftGearPiston.set(Constants.DriveTrain.HIGH_GEAR);
+    driveTrain.rightGearPiston.set(Constants.DriveTrain.HIGH_GEAR);
   }
 
   @Override