Purge code of all unused fields/classes. Only testing code.
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / OI.java
index 997be71cdbe551afe2477d093f6172a28c1cfe26..fdb91263fd289b31569a5b0f69285aed64803b7e 100644 (file)
@@ -1,14 +1,50 @@
 package org.usfirst.frc.team3501.robot;
 
+import org.usfirst.frc.team3501.robot.commands.driving.SetHighGear;
+import org.usfirst.frc.team3501.robot.commands.driving.SetLowGear;
+import org.usfirst.frc.team3501.robot.commands.driving.ToggleFront;
+import org.usfirst.frc.team3501.robot.commands.intakearm.RunIntake;
+import org.usfirst.frc.team3501.robot.commands.intakearm.StopIntake;
+import org.usfirst.frc.team3501.robot.commands.shooter.Shoot;
+
 import edu.wpi.first.wpilibj.Joystick;
+import edu.wpi.first.wpilibj.buttons.Button;
+import edu.wpi.first.wpilibj.buttons.JoystickButton;
 
 public class OI {
   public static Joystick leftJoystick;
   public static Joystick rightJoystick;
 
+  // left joystick buttons
+  public static Button gearTrigger;
+
+  // right joystick buttons
+  public static Button intakeTrigger;
+  public static Button shootBoulder;
+  public static Button toggleFront;
+
   public OI() {
     leftJoystick = new Joystick(Constants.OI.LEFT_STICK_PORT);
     rightJoystick = new Joystick(Constants.OI.RIGHT_STICK_PORT);
 
+    // Left joystick
+    gearTrigger = new JoystickButton(leftJoystick,
+        Constants.OI.LEFT_JOYSTICK_TRIGGER_PORT);
+    gearTrigger.whenPressed(new SetHighGear());
+    gearTrigger.whenReleased(new SetLowGear());
+
+    // Right joystick
+    intakeTrigger = new JoystickButton(rightJoystick,
+        Constants.OI.RIGHT_JOYSTICK_TRIGGER_PORT);
+    intakeTrigger.whenPressed(new RunIntake());
+    intakeTrigger.whenReleased(new StopIntake());
+
+    shootBoulder = new JoystickButton(rightJoystick,
+        Constants.OI.RIGHT_JOYSTICK_SHOOT_PORT);
+    shootBoulder.whenPressed(new Shoot());
+
+    toggleFront = new JoystickButton(rightJoystick,
+        Constants.OI.RIGHT_JOYSTICK_THUMB_PORT);
+    toggleFront.whenPressed(new ToggleFront());
   }
 }