X-Git-Url: http://challenge-bot.com/repos/?a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fsubsystems%2FIntakeArm.java;h=856db2bb139c5c23b0639783df255486eff9814b;hb=2781cca0354e26f8c5a6150d6b5179d300d479e1;hp=7ba04a3ec1030e704dbd2b5905d47764961ca39b;hpb=44efb06ef5bd8dbbaf008a50b7d566c676f0d525;p=3501%2Fstronghold-2016

diff --git a/src/org/usfirst/frc/team3501/robot/subsystems/IntakeArm.java b/src/org/usfirst/frc/team3501/robot/subsystems/IntakeArm.java
index 7ba04a3e..856db2bb 100755
--- a/src/org/usfirst/frc/team3501/robot/subsystems/IntakeArm.java
+++ b/src/org/usfirst/frc/team3501/robot/subsystems/IntakeArm.java
@@ -2,93 +2,80 @@ package org.usfirst.frc.team3501.robot.subsystems;
 
 import org.usfirst.frc.team3501.robot.Constants;
 
-import edu.wpi.first.wpilibj.AnalogPotentiometer;
 import edu.wpi.first.wpilibj.CANTalon;
+import edu.wpi.first.wpilibj.DoubleSolenoid;
 import edu.wpi.first.wpilibj.command.Subsystem;
 
 /***
  * The IntakeArm consists of two rollers that are controlled by one motor, with
  * a potentiometer on it.
  *
- * The motor controls the rollers, making them roll forwards and backwards.
- * The Intake rollers are on the back of the robot. As the rollers run, they
- * intake the ball.
+ * The motor controls the rollers, making them roll forwards and backwards. The
+ * Intake rollers are on the back of the robot. As the rollers run, they intake
+ * the ball.
  *
  * @author superuser
  *
  */
 
 public class IntakeArm extends Subsystem {
+
   private CANTalon intakeRoller;
-  private CANTalon intakeArm;
-  private AnalogPotentiometer intakePot;
+  private DoubleSolenoid leftIntake, rightIntake;
+  public static double moveIntakeArmSpeed = 0;
 
   public IntakeArm() {
     intakeRoller = new CANTalon(Constants.IntakeArm.ROLLER_PORT);
-    intakeArm = new CANTalon(Constants.IntakeArm.INTAKE_PORT);
-    intakePot = new AnalogPotentiometer(
-        Constants.IntakeArm.INTAKE_CHANNEL,
-        Constants.IntakeArm.FULL_RANGE,
-        Constants.IntakeArm.OFFSET);
+
+    leftIntake = new DoubleSolenoid(Constants.IntakeArm.LEFT_FORWARD,
+        Constants.IntakeArm.LEFT_REVERSE);
+
+    rightIntake = new DoubleSolenoid(Constants.IntakeArm.RIGHT_FORWARD,
+        Constants.IntakeArm.RIGHT_REVERSE);
   }
 
-  /***
-   * These two methods (intakeBall and outputBall)sets the voltage of the motor.
-   * The voltage values are constants in Constants class
-   */
-  public void intakeBall() {
-    intakeRoller.set(Constants.IntakeArm.INTAKE_SPEED);
+  public void retractPistons() {
+    leftIntake.set(Constants.IntakeArm.RETRACT);
+    rightIntake.set(Constants.IntakeArm.RETRACT);
   }
 
-  public void outputBall() {
-    intakeRoller.set(Constants.IntakeArm.OUTPUT_SPEED);
+  public void extendPistons() {
+    leftIntake.set(Constants.IntakeArm.EXTEND);
+    rightIntake.set(Constants.IntakeArm.EXTEND);
   }
 
   /***
-   * This method gets you the current voltage of the motor that controls the
-   * intake arm roller. The range of voltage is from [-1,1].
-   * A negative voltage makes the motor run backwards.
-   *
-   * @return Returns the voltage of the motor that controls the roller. The
-   *         range of the voltage goes from [-1,1].
-   *         A negative voltage indicates that the motor is running backwards.
+   * This method sets the voltage of the motor to intake the ball. The voltage
+   * values are constants in Constants class
    */
-
-  public double getRollerVoltage() {
-    return intakeRoller.get();
+  public void intakeBall() {
+    intakeRoller.set(Constants.IntakeArm.INTAKE_SPEED);
   }
 
   /***
-   * This method sets the voltage of the arm motor. The range is from [-1,1]. A
-   * negative voltage makes the direction of the motor go backwards.
-   *
-   * @param voltage
-   *          The voltage that you set the motor at. The range of the voltage of
-   *          the arm motor is from [-1,1]. A
-   *          negative voltage makes the direction of the motor go backwards.
+   * This method sets the voltage of the motor to output the ball. The voltage
+   * values are constants in Constants class
    */
+  public void outputBall() {
+    intakeRoller.set(Constants.IntakeArm.OUTPUT_SPEED);
+  }
 
-  public void setArmVoltage(double voltage) {
-    if (voltage > 1)
-      voltage = 1;
-    else if (voltage < -1)
-      voltage = -1;
-
-    intakeArm.set(voltage);
+  public void stopRollers() {
+    intakeRoller.set(0);
   }
 
   /***
    * This method gets you the current voltage of the motor that controls the
-   * intake arm. The range of voltage is from [-1,1].
-   * A negative voltage makes the motor run backwards.
+   * intake arm roller. The range of voltage is from [-1,1]. A negative voltage
+   * makes the motor run backwards.
    *
-   * @return Returns the voltage of the motor that controls the arm. The
-   *         range of the voltage goes from [-1,1].
-   *         A negative voltage indicates that the motor is running backwards.
+   * @return Returns the voltage of the motor that controls the roller. The
+   *         range of the voltage goes from [-1,1]. A negative voltage indicates
+   *         that the motor is running backwards.
    */
 
-  public double getArmVoltage() {
-    return intakeArm.get();
+  public double getRollerVoltage() {
+    return intakeRoller.get();
   }
 
   /***
@@ -112,18 +99,11 @@ public class IntakeArm extends Subsystem {
    */
 
   public boolean areRollersRolling() {
+    if (Math.abs(getRollerVoltage()) < 0.02)
+      return false;
     return true;
   }
 
-  /***
-   * This method gets the angle of the potentiometer on the Intake Arm.
-   *
-   * @return angle of potentiometer
-   */
-  public double getIntakePot() {
-    return intakePot.get();
-  }
-
   @Override
   protected void initDefaultCommand() {