Add to ToggleBallRollerIntake command

diff --git a/src/org/usfirst/frc/team3501/robot/commands/ToggleBallRollerIntake.java b/src/org/usfirst/frc/team3501/robot/commands/ToggleBallRollerIntake.java
index d75814862ee78862308f8f4772069ae435e2ff55..4ae8f5f55ed88ba76720b52b1ce915423ea03509 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/commands/ToggleBallRollerIntake.java
+++ b/src/org/usfirst/frc/team3501/robot/commands/ToggleBallRollerIntake.java
@@ -1,5 +1,7 @@
 package org.usfirst.frc.team3501.robot.commands;
 
+import org.usfirst.frc.team3501.robot.Robot;
+
 import edu.wpi.first.wpilibj.command.Command;
 
 public class ToggleBallRollerIntake extends Command {
@@ -10,6 +12,10 @@ public class ToggleBallRollerIntake extends Command {
 
   @Override
   protected void initialize() {
+    if (areRollersRolling()) {
+      Robot.intakeArm.stopRollers();
+    } else
+      Robot.intakeArm.intakeBall();
   }
 
   @Override