X-Git-Url: http://challenge-bot.com/repos/?p=3501%2Fstronghold-2016;a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fsubsystems%2FIntakeArm.java;h=1870799debfc45f510217aded8ae180c73417dba;hp=5e00d05f0df999e6870ba06e5b32d8bee168002d;hb=5cff891038f613483040c7f1a2b5b554adcd3313;hpb=e4fbab026f4a68a4a238839ae2295c56c1134434 diff --git a/src/org/usfirst/frc/team3501/robot/subsystems/IntakeArm.java b/src/org/usfirst/frc/team3501/robot/subsystems/IntakeArm.java index 5e00d05f..1870799d 100755 --- a/src/org/usfirst/frc/team3501/robot/subsystems/IntakeArm.java +++ b/src/org/usfirst/frc/team3501/robot/subsystems/IntakeArm.java @@ -2,8 +2,8 @@ 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; /*** @@ -21,16 +21,17 @@ import edu.wpi.first.wpilibj.command.Subsystem; public class IntakeArm extends Subsystem { private CANTalon intakeRoller; - private CANTalon intakeArm; - private AnalogPotentiometer intakePot; - public static double[] potAngles = { 0, 30, 45, 90 }; // TODO: correct angles + private DoubleSolenoid leftIntake, rightIntake; public static double moveIntakeArmSpeed = 0; public IntakeArm() { intakeRoller = new CANTalon(Constants.IntakeArm.ROLLER_PORT); - intakeArm = new CANTalon(Constants.IntakeArm.ARM_PORT); - intakePot = new AnalogPotentiometer(Constants.IntakeArm.POT_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); } /*** @@ -67,39 +68,6 @@ public class IntakeArm extends Subsystem { return intakeRoller.get(); } - /*** - * 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. - */ - - public void setArmSpeed(double voltage) { - if (voltage > 1) - voltage = 1; - else if (voltage < -1) - voltage = -1; - - intakeArm.set(voltage); - } - - /*** - * 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. - * - * @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. - */ - - public double getArmSpeed() { - return intakeArm.get(); - } - /*** * This method checks to see if the presence of the ball inside is true or * false. @@ -126,24 +94,6 @@ public class IntakeArm extends Subsystem { return true; } - /*** - * This method gets the angle of the potentiometer on the Intake Arm. - * - * @return angle of potentiometer - */ - - public double getArmAngle() { - return intakePot.get() + Constants.IntakeArm.ZERO_ANGLE; - } - - public void stop() { - setArmSpeed(0); - } - - public double getAngleForLevel(double targetLevel) { - return potAngles[(int) (targetLevel - 1)]; - } - @Override protected void initDefaultCommand() {