Commit | Line | Data |
---|---|---|
7b11350e KZ |
1 | package org.usfirst.frc.team3501.robot.subsystems; |
2 | ||
3 | import org.usfirst.frc.team3501.robot.Constants; | |
4 | ||
5 | import edu.wpi.first.wpilibj.CANTalon; | |
5cff8910 | 6 | import edu.wpi.first.wpilibj.DoubleSolenoid; |
7b11350e KZ |
7 | import edu.wpi.first.wpilibj.command.Subsystem; |
8 | ||
add57fee | 9 | /*** |
1eb84222 SC |
10 | * The IntakeArm consists of two rollers that are controlled by one motor, with |
11 | * a potentiometer on it. | |
a68e4347 | 12 | * |
dc394eb0 SG |
13 | * The motor controls the rollers, making them roll forwards and backwards. The |
14 | * Intake rollers are on the back of the robot. As the rollers run, they intake | |
15 | * the ball. | |
a68e4347 | 16 | * |
add57fee | 17 | * @author superuser |
a68e4347 | 18 | * |
add57fee YA |
19 | */ |
20 | ||
7b11350e | 21 | public class IntakeArm extends Subsystem { |
4e0d6389 LM |
22 | |
23 | private CANTalon intakeRoller; | |
5cff8910 | 24 | private DoubleSolenoid leftIntake, rightIntake; |
54c588d9 | 25 | public static double moveIntakeArmSpeed = 0; |
4e0d6389 LM |
26 | |
27 | public IntakeArm() { | |
a68e4347 | 28 | intakeRoller = new CANTalon(Constants.IntakeArm.INTAKE_ROLLER_PORT); |
5cff8910 | 29 | |
a68e4347 | 30 | leftIntake = new DoubleSolenoid(Constants.IntakeArm.LEFT_INTAKE_MODULE, |
7988f380 HD |
31 | Constants.IntakeArm.LEFT_INTAKE_FORWARD, |
32 | Constants.IntakeArm.LEFT_INTAKE_REVERSE); | |
5cff8910 | 33 | |
a68e4347 | 34 | rightIntake = new DoubleSolenoid(Constants.IntakeArm.RIGHT_INTAKE_MODULE, |
7988f380 HD |
35 | Constants.IntakeArm.RIGHT_INTAKE_FORWARD, |
36 | Constants.IntakeArm.RIGHT_INTAKE_REVERSE); | |
4e0d6389 LM |
37 | } |
38 | ||
2781cca0 ME |
39 | public void retractPistons() { |
40 | leftIntake.set(Constants.IntakeArm.RETRACT); | |
41 | rightIntake.set(Constants.IntakeArm.RETRACT); | |
42 | } | |
43 | ||
44 | public void extendPistons() { | |
45 | leftIntake.set(Constants.IntakeArm.EXTEND); | |
46 | rightIntake.set(Constants.IntakeArm.EXTEND); | |
47 | } | |
48 | ||
4e0d6389 LM |
49 | /*** |
50 | * This method sets the voltage of the motor to intake the ball. The voltage | |
51 | * values are constants in Constants class | |
52 | */ | |
53 | public void intakeBall() { | |
54 | intakeRoller.set(Constants.IntakeArm.INTAKE_SPEED); | |
55 | } | |
56 | ||
57 | /*** | |
58 | * This method sets the voltage of the motor to output the ball. The voltage | |
59 | * values are constants in Constants class | |
60 | */ | |
61 | public void outputBall() { | |
62 | intakeRoller.set(Constants.IntakeArm.OUTPUT_SPEED); | |
63 | } | |
64 | ||
2b65c91d | 65 | public void stopRollers() { |
33141cdd | 66 | intakeRoller.set(0); |
2b65c91d LM |
67 | } |
68 | ||
4e0d6389 LM |
69 | /*** |
70 | * This method gets you the current voltage of the motor that controls the | |
71 | * intake arm roller. The range of voltage is from [-1,1]. A negative voltage | |
72 | * makes the motor run backwards. | |
a68e4347 | 73 | * |
4e0d6389 LM |
74 | * @return Returns the voltage of the motor that controls the roller. The |
75 | * range of the voltage goes from [-1,1]. A negative voltage indicates | |
76 | * that the motor is running backwards. | |
77 | */ | |
78 | ||
79 | public double getRollerVoltage() { | |
80 | return intakeRoller.get(); | |
81 | } | |
82 | ||
4e0d6389 LM |
83 | /*** |
84 | * This method checks to see if the presence of the ball inside is true or | |
85 | * false. | |
a68e4347 | 86 | * |
4e0d6389 LM |
87 | * @return Returns whether the ball is inside as true or false |
88 | */ | |
89 | ||
90 | public boolean isBallInside() { | |
91 | return true; | |
92 | } | |
93 | ||
94 | /*** | |
95 | * This method checks to see if the motors controlling the rollers are | |
96 | * currently running. | |
a68e4347 | 97 | * |
4e0d6389 LM |
98 | * @return Returns whether the motors are currently running, and returns the |
99 | * state of the condition (true or false). | |
a68e4347 | 100 | * |
4e0d6389 LM |
101 | */ |
102 | ||
103 | public boolean areRollersRolling() { | |
42c4c734 LM |
104 | if (Math.abs(getRollerVoltage()) < 0.02) |
105 | return false; | |
4e0d6389 LM |
106 | return true; |
107 | } | |
108 | ||
4e0d6389 LM |
109 | @Override |
110 | protected void initDefaultCommand() { | |
111 | ||
112 | } | |
7b11350e | 113 | } |