7625d6ab4f60904ef47232dcc1c25d94a4497f43
1 package org
.usfirst
.frc
.team3501
.robot
.commands
.intakearm
;
3 import org
.usfirst
.frc
.team3501
.robot
.Constants
.IntakeArm
;
4 import org
.usfirst
.frc
.team3501
.robot
.Robot
;
6 import edu
.wpi
.first
.wpilibj
.command
.Command
;
8 public class RunIntake
extends Command
{
11 public RunIntake(int direction
) {
12 requires(Robot
.intakeArm
);
13 this.direction
= direction
;
17 protected void initialize() {
18 if (direction
== IntakeArm
.IN
)
19 Robot
.intakeArm
.intakeBall();
20 else if (direction
== IntakeArm
.OUT
)
21 Robot
.intakeArm
.outputBall();
23 Robot
.intakeArm
.stopRollers();
27 protected void execute() {
29 Robot
.intakeArm
.outputBall();
33 protected boolean isFinished() {
38 protected void end() {
42 protected void interrupted() {
45 // while holding right trigger, intake intakes
46 // it intakes until it sees the ball with the photogate
47 // as soon as it sees the ball, it outtakes for 0.2 seconds.
48 // after this happens, the right trigger does nothing for 2 seconds