finish photogate insertion

[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / commands / intakearm / RunIntake.java

diff --git a/src/org/usfirst/frc/team3501/robot/commands/intakearm/RunIntake.java b/src/org/usfirst/frc/team3501/robot/commands/intakearm/RunIntake.java
index 7d2e490a00eda1b196cfdc8fdf871285e7556c00..649ed5cf503232435539b6600a36f359a4d73f95 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/commands/intakearm/RunIntake.java
+++ b/src/org/usfirst/frc/team3501/robot/commands/intakearm/RunIntake.java
@@ -25,6 +25,8 @@ public class RunIntake extends Command {
 
   @Override
   protected void execute() {
+    if (Photogate.ballState())
+      Robot.intakeArm.outputBall();
   }
 
   @Override
@@ -40,4 +42,9 @@ public class RunIntake extends Command {
   protected void interrupted() {
   }
 
+  // while holding right trigger, intake intakes
+  // it intakes until it sees the ball with the photogate
+  // as soon as it sees the ball, it outtakes for 0.2 seconds.
+  // after this happens, the right trigger does nothing for 2 seconds
+
 }